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ABSTRACT 


Approaches to Control 
of 

The Large Angle Magnetic Suspension Test Fixture 


Mehran Ghofrani 
Old Dominion University, 1992 
Advisor: Dr. Colin P. Britcher 

The Large Angle Magnetic Suspension Test Fixture is a five degree-of- 
freedom system, developed and built at NASA Langley Research Center. It is 
intended for study of control techniques in magnetic suspension systems with large 
angular capabilities. In this study, steps have been taken to prove the system in 
practice, using the existing hardware. A classical control approach, using dual 
phase advance compensators, is applied in simulation and hardware. A single 
decoupled degree-of-freedom of the system is stabilized and controlled in 
simulation. The procedure is then employed for all five degrees- of-freedom. The 
design and implementation of an analog and a digital controller are described. 
Results from simulation and the actual system are compared and analyzed. The 
ability of the system to sustain suspension over a large angular range has been 
proven in hardware. 
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CHAPTER 1 


INTRODUCTION 


The concept of magnetic levitation and magnetic suspension is not new m 
origin. Many successful attempts have been made throughout this century. 
According to reference 1, Kemper suspended a mass of 210 kg in 1935. 
Advancements in control systems and electronics have greatly increased the 
interest and achievements in this area. The first practical actively controlled 
magnetic suspension, built at the University of Virginia in 1937 [2), is the basis of 
most modern magnetic suspension applications. Magnetic suspension can be 
applied to many fields, some of which are contact-less magnetic bearings (3), 
levitated trains [4], supports for wind tunnel models [5], and vibration isolation 


( 6 ). 

In some literature the term “suspension’ is used in situations where an object 
is supported by magnetic forces from above, and the term “levitation” is used for 
cases where the object is repelled from forces below. There are cases where a 
combination of the two may be employed. However, in this study the two terms 


will be used interchangeably. 

There are two major groups of applications of magnetic suspension, small gap 
and large gap. The term “gap” refers to the ratio of distance between the 
suspended element and the actuator to the actuator sise. The two groups differ in 
analysis methods. In a small gap magnetic suspension system, the field at the 
surface of the actuator may be assumed uniform, and magnetic circuit theory may 



be utilized [7], A large gap magnetic suspension system may require a full three- 
dimensional analysis of the magnetic field at the point of suspension [8], The gap 
can be as low as a fraction of a mm in small gap applications and as large as 
several meters in large gap systems. An example of a small gap application is 
magnetic bearings, and of a large gap application is the wind tunnel support 
systems. Here only large gap magnetic levitation is discussed. 

A simple classical example of magnetic suspension is the case of a steel ball 
suspended by an electromagnetic coil above it. As shown in figure 1.1, the ball’s 
weight is supported by the magnetic field generated by the current flowing 
through the coil. This system is inherently unstable, therefore an active feedback 
controller is necessary to stabilize the system. A simple optical sensor can be used 
to detect the position of the steel ball, and the signal is fed back to the controller. 
The first stage of the controller is usually a comparator, which compares the 
actual position to the desired position. The error from the comparator is passed 
through some form of a lead compensator, to accommodate the lag due to the cod 
and the mass of the ball. This produces a feedback signal based on the rate of the 
error signal. The compensated signal is finally fed to a current power amplifier 


which supplies the coil [9]. 



Source 


Figure 1.1- Single degree-of-freedom steel ball suspension 
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The example given above has only one degree-of-freedom but is 
representative of the many complex systems possible. One such system is the 
Large Angle Magnetic Suspension Test Fixture (LAMSTF). The LAMSTF is a 
research apparatus developed at NASA Langley Research Center. It is designed 
to control a suspended element in five degrees-of-freedom, with the capability of 
full 360° rotation about its vertical axis. The technology is adoptable to 
applications such as vibration isolation and accurate positioning systems [10]. 

In this phase of the research the primary goal is to make the presently 
available hardware operational. This is a proof-of-concept step leading to later 
studies of performance maximization [11]. After describing the available hardware 
and its modeled dynamics, the steps leading to implementation of an analog and a 
digital controller for LAMSTF are presented. In the final phase, the large angular 
capability of this system is demonstrated in practice. 
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CHAPTER 2 


THE LARGE ANGLE MAGNETIC SUSPENSION TEST FIXTURE 

2.1 General Description 

The distinct design feature of LAMSTF is its “planar array” electromagnetic 
coil arrangement. Five coils are mounted on the perimeter of a circle of about 
13.77 cm radius, at a spacing of 72° apart, on a 1/2” thick, square aluminum 
plate. All the coils are positioned with their axes parallel to the axis of the circle. 
The aim of the design is to levitate an element, filled with permanent magnet 
material, at a height of about 10 cm above the coils. A sketch of this 
arrangement is shown in figure 2.1. Since there are no electromagnets above, all 
the suspension forces would be repulsive, and directed from below a horizontal 
plane over the coils. The pure repulsive force suspension method is one of the 
unusual features of this system [12] [13]. The system would be required to control 
the suspended element in five degrees-of-freedom, and this has required a 
minimum of five electromagnetic actuator coils [14]. 

In this chapter the details of the plant are described. The plant primarily 
consists of the suspended element, the sensors, the coils, and the power amplifiers. 

2.2 The Suspended Element 

The suspended element is an aluminum tube about 5.32 cm long and 0.9525 
cm outside diameter. The tube is filled with 16 wafers of Neodymium-Iron-Boron 
(Nd-Fe-B) permanent magnet material. Each magnetic wafer is 0.7963 cm in 
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diameter and 0.3135 cm in thickness, having a magnetization of about 

9.5493 x 10' 5 A/m. The wafers are arranged in N-S-N-S sequence and are epoxied 

into the aluminum tube, resulting in a total mass of about 22.5 grams. Using the 

bifilar pendulum method, the moment of inertia of the model about its transverse 

6 2 

axis was found to be approximately 5.508 x 10 kg.m . 


z 


X 


Figure 2.1-The planar array coil configuration 



y 


2.3 Position Sensors 

The detection of the core’s position is performed by five sets of infrared LEDs 
and sensors. These LED-sensor pairs arc installed in two perpendicular planes 
(vertical and horizontal), which allow detection of five degrees-of-freedom of the 
core. The beams from the infrared LEDs, which are incident on the sensors, 
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would be partially blocked by the suspended element. The relative position of the 
core can then be determined from the amount of light received. This method is 
common in wind tunnel magnetic suspension applications and has been quite 
successful. 

The LEDs and sensors presently used are intended for fiber-optics. Their 
advantages are that they are compact and inexpensive. However, the beams from 
the LEDs have a dispersion of about 20° (included cone angle), which significantly 
reduces the amount of light received by the sensors. To collimate the beams from 
the LED’s, miniature plano-convex lenses were installed on the LEDs and sensors. 
The lenses are secured in aluminum tubes which also act as shields to stray light. 

The sensors and LEDs are all mounted on an aluminum framework which is 
above the coil array. This framework has the ability to rotate about the veitical 
axis a full 360°. The schematic diagram of the sensor arrangement is shown in 
figure 2.2. 



Figure 2.2 A sketch of the sensor frame 
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2.4 Coils and Power Amplifiers 

The currents through the coils are controlled by five switching power 
amplifiers, capable of delivering a maximum of 30A continuous and 60A peak 
level. The amplifiers, which are commercially purchased, have a switching 
frequency of 22 KHz, and require a D.C. supply of 150 V. The amplifiers are 
equipped with individual enable switches and output current read-outs. The 
power amplifiers, their power supplies, and their supporting circuitry are housed 
in an enclosed chassis. These amplifiers function in a voltage-to-current convertor 
mode. Their response behavior and sensitivity are, to some degree, user 
adjustable. The amplifiers are set to give a flat response find to have a gain of 3 
A/V. The outputs of the amplifiers are directly connected to the coils via cables. 

The electromagnetic coils are made of 509 turns of AWG 10 enameled copper 
wire wound on bakelite spools, with soft iron cores. The windings on the coils are 
covered with epoxy resin to reduce deformity due to high current forces. The 
electrical characteristics of the coils has been measured as follows: 


Resistance 

0.74 n 

Self Inductance 

27.5 mH 

Mutual Inductance: 


(adjacent) 

1.6 mH 

(non- adjacent) 

0.37 mH 


Table 2.1- Coil Specifications (with iron core) 


The coils cannot adequately dissipate the thermal energy generated in them 
due to their internal resistances. A 30 minute run of one coil at 15A, starting 
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from room temperature, resulted in temperature of about 150T. To protect 
against thermal runaway, each coil has been equipped with a temperature sensing 
device, which is monitored by a set of five digital temperature controllers. These 
controllers axe of the OMEGA CN9000 series. The temperature controllers are 
connected such that they can activate an alarm and disable the power amplifiers 
at set temperatures. The temperature controllers are presently set to sound ail 
alaxm at 150° F and to disable the amplifiers at 160° F. 
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CHAPTER 3 


SYSTEM MODELING 

In order to study the behavior of the system, an accurate model of the plant 
is necessary. The plant includes the dynamics of the suspended element, the coils, 
and the power amplifiers. The mathematical model of the plant has been derived 
in detail in reference 15, however a brief summary will be given here for 
demonstration. 

In general, magnetic systems are nonlinear [16]. After developing a nonlinear 
model, a linearizing procedure is performed to simplify analysis and 
implementation. This chapter first shows the basic steps in developing the 
nonlinear plant model, after which linearization steps are presented. Numerical 
results are provided later which are then used to study the actual plant’s 
dynamics. 

3.1 Nonlinear Plant Equations 

A set of coordinate systems needs to be defined in order to model the motions 
of the core and analyze its dynamics. Figure 3.1 illustrates the coordinate system 
arrangement defined for this system. An orthogonal right-handed coordinate 
system is attached to the core and is referred to as the core coordinate system. Its 
components axe denoted as x, y, and z. The origin of the core coordinate system 
is placed at the centroid of the core, with its x axis along the axis of the core. 
The inertial coordinate system is denoted by x, y, and z; it is fixed with respect to 


9 



the coils. The x axis of the inertial system always intersects the axis of coil one. 
The core coordinates are initially coincident with the inertial coordinates. 



Figure 3.T The coordinate systems of the LAMSTF 


As the core moves from the zero position, the core coordinates deviate from the 
inertial coordinates. In order to locate the coils with respect to the inertial 
system, a third coordinate system is attached to the coil array at a distance li 
below the inertial coordinate system. The components of this system are denoted 
as x^, y^, and z^. The x^ and y^ axes are parallel to x and y axes of the inertial 
system, respectively, and the z^ is coincident with the z [15]. 

Using traditional aircraft dynamics terminology, the motions of the core are 
defined as follows: Roll is rotation about the x axis. Yaw is rotation about the z 
axis; Pitch is rotation about the y axis. The linear motions are axial, side, and 
vertical denoted by x, y, and z. The sign convention follows the right-hand rule 
definition. 
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One of the assumptions made in the design of this system is that the model 
would initially suspend at zero inertial coordinate position. However, the system 
should later be capable of tracking the core through a 360° rotation about the z 
axis. Since the core’s magnetization is in the direction of its x axis, there would 
be no control of roll motion. The motions in all other degrees-of- freedom, axial, 
side, vertical, and pitch, are kept to very small amounts. 


3.1.1 Equations of Motion 

The assumptions used to derive the equations of motion for the core are that 
the core is a rigid body, the core has negligible product of inertia, and that the 
core has no rolling motion. Therefore, the inertia matrix for the core would be a 
3x3 diagonal matrix with I y = I z = I c [15]. 


[i] 


lx o 0 

0 Ic 0 

0 o I c 


Using the general angular momentum equation 

h = [i] a 


(3.1) 


The torque on the suspended element can then be written as follows: 


T = H = [I] H + U x ( [I] S ) 


(3.2) 


By performing some mathematical manipulations the above equation can be 
rewritten as below: 
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(3.3) 


T = [I] n + [n ] [I] H 


The term [fi] is a skew-symmetric cross product matrix shown in equation 3.4. 


m 


0 ^ 
% 0 fi* 

Q- y fi* 0 


(3.4) 


Solving equation 3.3 for angular acceleration the following equation is obtained: 


S= [I] 1 ( T -|fi][l]8) 


(3.5) 


Since there is no rolling motion, equation 3.5 simplifies to the following: 



(3.6) 


The force on the core can likewise be determined. In the coordinates of the core 
the force can be written as below: 


F = m c ( V + [fl] V) (3.7) 

Solving for the acceleration one can obtain the following: 

V = lA; P - [t5 ] V (3.S) 
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3.1.2 Torques and Forces on the Magnetic Core 

The suspended element is subject to forces and torques generated from the 
interaction of the magnetic field from the coils and the field from the permanent 
magnet core. The governing equations for torque and force are shown in 
equations 3.9 and equation 3.10 respectively [15]: 

T = J ( U x B ) dV 
V 

F = J ( M • V ) B dV 
V 

Where the gradient operator is defined as: 

v T = \JL JL M-~\ mi 'i 

Idx dy 8z\ ( 3 - n ) 

The magnetization of the core can be assumed to be uniform over the volume of 
the core. The size of the core compared to its distance to the coils and the coils 

themselves is small. It is assumed that the fields in the region of the core are 

linear functions of position. Therefore, the gradients of the fields are constants 
over the volume of the core. The integrals in equations 3.9 and 3.10 can now be 
approximated as the core s volume multiplied by the relevant integrand, 
evaluated at the centroid of the core. The resulting equations are shown below: 

T ~ V ( U x B 0 ) (3.12) 

Similarly the force equation reduces to the following: 

F ~ V ( U • V) B 0 
13 


(3.9) 

(3.10) 


(3.13) 



The dot product in equation 3.13 produces a scalar. Combining this result with 
the flux density vector B, using tensor algebra, the above equation can be written 
as follows: 


(3.14) 

(3.15) 


From Maxwell’s equation, V x B = 0, the above matrix must be symmetrical in 
the region of the core. Further, applying the identity V ■ B = 0, the diagonal 
terms of the matrix must be zeros. 

In the above equations, M is represented with respect to the core coordinates 
and B is represented with respect to the inertial coordinates. This mismatch in 
the coordinate systems can be resolved by transforming B to the core coordinate 
system, using a transformation matrix T m . 


F = V [ dB ] M 


where 


[dB] = 


B xx B xy B xz 
B yx B yy B yz 
B zx B zy B zz 


and where 


B ..=S 

u dj 


T = V [M] [T m ] B 


(3.16) 


f = V [T m ] [dB] [T m ]- 1 M 


where 


T = 

x m 


cos 0, sin(? 2 
-sin 0 Z cos 0 2 
0 0 


0 

0 

1 


(3.17) 


(3.18) 
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3.1.3 System Equations 

The next step in developing the plant model is to combine the equations of 
motion with the torque and force equations. Substituting the torque equation into 
the angular acceleration equation, the following result is obtained: 

n = f v [M] [T m | B (3.19) 

l C 

Similarly, substituting the force equation into the linear acceleration equation 
results in the following: 


v = ^ v [T m ] [3B] [T m ] _1 M (3.20) 

Equations 3.19 and 3.20 axe the basic equations of motion for the core in core 
coordinates, neglecting torques and forces due to disturbances. The variable 
inputs in these equations are the field intensity vector B and the field intensity 
gradient matrix [<9B]. Since the core is held fixed at its operating point with only 
small displacements, the assumption can be made that the field components and 
their gradients are only functions of coil currents. The field intensity vector can 
now be represented by a linear combination of the coil currents [15]. 

B = — |K b 1 f (3.21) 

A max 

Each column in [Iv B ] corresponds to a coil and contains field components produced 
by that coil at a maximum current Inrax. The vector I contain the coil current. 

The same arrangement can be made for the gradients, by arranging the field 
gradient’s three columns into one column and representing it as vector. 
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In equation 3.22 [K^g] contains field gradients in its columns at maximum 
current, for each coil. The values in the two matrices [Kg] and [K^g] are 
determined using a magnetic field analysis software which uses the finite element 
method for the given configuration [17]. 

OB = fJ- [K aB ] I' (3.22) 

The equations of motion can now be integrated to relate the input currents to 
the core position. However, the above model is nonlinear due to the coordinate 
transformations involved. A linearizing technique should be employed to simplify 
analysis and implementation. 

3.2.1 Linearization of the system model 

The system can now be linearized and put in a state space format for 

analysis. The details of the linearization of the plant model can be found in 

reference 18, however a summary of the steps involved is presented here. One can 
simplify the equations of motion by using small angle approximation. This is 
based on the assumption that displacement angles about the z and y axis are 
small; this results in sin# ~ 0 and cos0 ~ 1. With these approximations the torque 
and force equations can be simplified to the following equations. 

Tj=V«i( B r - Bj) (3.23) 

Tf =VMj( -0, B, - B„) (3.24) 

Fj=VM i (B„ + 2 ». B Ijr - 2 B s B„ ) + m c g (3.25) 
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Fj = V Mj ( -6g B xx + B xy + e z Byy - 8 y B yz ) (3.26) 

F t = VMj ( Oy B xx + B xz + 6 Z By. - e y B„ ) (3.27) 


The above torque and force equations can be expressed in terms of angular 
and linear accelerations. As developed earlier, the fields and field gradients can be 
represented as functions of coil currents only. This will result in a set of nonlinear 
differential equations. These equations represent a system with currents as input 
and core position rates as output. A set of relevant variables X can be defined, 
and X can be expressed as a function of X and I, shown in equations 3.28 and 
3.29, respectively. 


x T = [ n z e y e z v Y Vj v T x y z j 


(3.28) 


X = f ( (9y, 9 Z , x, y, z) = f 



(3.29) 


The method used here to linearize the system is the Taylor series expansion about 
a fixed point. Using only the first order terms of the series and subtracting the 
initial operating point [18] one obtains the following: 


where 


6% = A 6X + B 61 


(3.30) 


A = W 2 


d f(T, F ) 

dX 


X.,1, 


B = W. 


d f(T, F) 
d I 


X. f I, 


(3.31) 

(3.32) 
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*^2 is a diagonal matrix with moment of inertia I c and core mass m c arranged in 
its diagonal. 


VM X 

Ic 

0 


0 

VM X 

Ic 


1 


W 2 = 


L 


0 


0 


1 

VM X 

m r 

VM X 

m c 

VM X 

m c 

1 : 
1 0 
0 1 


(3.33) 


Matrix A can be expanded and simplified to the following: 


0 

0 

- 

B x 

0 

0 

0 

0 

-B xz 

■Byz 

■Bzz 

0 

0 


0 

-B x 

0 

0 

0 

“Byz 

Byy 

Byz 

1 

0 


0 

0 

0 

0 

0 

0 

0 

0 

0 

1 


0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

( m cg 

WM* 

~ 2B XX ) 

2B X y 

0 

0 

0 

B(xx)x 

B (xx)y 

B(xx)z 

0 

0 


Byz (B 

yy*B xx 

;) 0 

0 

0 

B (xy)x 

B (xy)y 

B (xy)z 

0 

0 

(Bxx 

-Bzz) 

Byz 

0 

0 

0 

B( x z)x 

B (xz)y 

B(xz)z 

0 

0 


0 

0 

1 

0 

0 

0 

0 

0 

0 

0 


0 

0 

0 

1 

0 

0 

0 

0 

0 

0 


0 

0 

0 

0 

1 

0 

0 

0 


(3.34) 
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Following some manipulations as in [18], assuming that the coil currents are 
not affected by the core movements and neglecting small terms, the B matrix can 
simplified to the following: 


B = 




X max 


-K’l 

-K Z2 • 

-K’3 ' 

K‘4 - 

k Z5 

K xi 

Ky 2 

Ky 3 

Ky 4 

Ky 5 


... 

0 •• 




... 

0 •• 



Kxx t 

K xx 2 

Kxx 3 

Kxx 4 

Kxx 5 

Kxy x 

Kxy 2 

Kxy 3 

Kxy 4 

K xy s 

K XZl 

K XZ2 

K XZ 3 

K X z 4 

Kxz 5 


... 

0 •• 

• 




. o- 




. . . 

0 •• 

. 



(3.35) 


The system model is now linearized. Using the state variables defined in 
equation 3.28 and the above A and B matrices, the state-space representation of 
the system can now be analyzed. 

3.2.2 Initial Condition 

In the absence of gravitation and disturbances the core would suspend at a 
defined zero position, in this case at a height of 10 cm above the top of the coils 
over the center of the array, with no current through the coils. However, in order 
to compensate for the weight of the model, a set of steady currents should be 
supplied to the coils. This results in a constant force F- z shown below, with all 
other forces and torques equal to zero. 

F 2 = m c g (3.36) 
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The above conditions will results in the following: 


By — B z — B xx — B x y — 0 


(3.37) 


B 


xz — 


m c g 

¥M X 


(3.38) 


From equation 3.35, the initial current can be calculated using the following. 


1q — ^max 



-1 

— “1 

[K y ] 


By 

[K*] 


b 2 

[K xx ] 


Bxx 

[K xy ] 


B X y 

[I<xzl 


Bxz 


(3.39) 


Note that the the only non-zero term in the B matrix is B xz . Since the K matrix 
is square with non-zero determinant, and is therefore invertible, Iq can readily be 
determined. 


3.3 Numerical Analysis 

The numerical values for the magnetic field intensity and its gradients at the 
point of suspension can be calculated in two steps. The Biot-Savart law may be 
used to determine the fields and field gradients due to the currents in the coils 
with no iron core present [19]. A finite difference method can then be applied to 
the result to account for the effect of the iron cores, through an iterative process. 
To solve the equations involved in this method would be very tedious. A 
magnetic field analysis software, based on finite element and finite difference 
methods, has been used to determine the field intensity and its gradients at the 
point of interest [6]. Assuming a constant current of 10A through the coils, the 


20 



following table, containing 
been determined. 


field intensities, their first and second gradients, has 


Coil 

B x , 

T 

By, 

T 

B z , 

T 

Bxxi 

T/m 

B x y> 

T/m 

B xz , 

T/m 

Byy, 

T/m 

By Z , 

T/m 

B zz , 

T/m 

1 

0.00231 


-0.00094 

0.02179 


-0.02723 

-0.0189 


-0.00287 

2 

0.00071 

0.00220 


-0.01503 

0.01196 

-0.02203 

0.01790 

-0.02590 


3 

-0.00187 

0.00136 


0.00772 

-0.01936 

0.02203 

-0.00485 

-0.01600 


4 

-0.00187 

-0.00136 


0.00772 

0.01936 

0.02203 

-0.00485 

0.01600 


5 

0.00071 

-0.00220 


-0.01503 

-0.01936 

-0.00841 

-0.0179 

0.02590 



Table 3.1- Electromagnet fields and first-order gradients 


Coil 

B (xx)x’ 

T/m/m 

B (xy)x’ 

T/m/m 

B (xz)x’ 

T/m/m 

B (xy)y’ 

T/m/m 

B (xy)z’ 

T/m/m 

B (xz)z’ 

T/m/m 

1 

0.03434 

0 

-0.53466 

-0.21916 

0 

0.00254 

2 

-0.18276 

-0.14560 

0.16371 

-0.11938 

0.08735 

0.00078 

3 

0.16559 

0.13733 

-0.26790 

0.22896 

-0.14134 

-0.00205 

4 

0.16559 

-0.13733 

-0.26790 

0.22896 

0.14134 

-0.00205 

5 

-0.18276 

0.14560 

0.16371 

-0.11938 

-0.08735 

0.00078 


Table 3.2 - Electromagnet second-order gradients 
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The matrices A , *36 and are shown below after numerical substitution. 


0 

0 

7.846e-3 

0 

0 

0 

0 

-9.25e-2 

0 

0 

0 

0 

0 

7.846e-3 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

-9.25e-2 

0 

0 

0 

0 

4.710e-l 

0 

-2.366e-4 

0 

0 

0 

0 

0 

0 

0 

0 9.015e-l 0 

0 

0 

0 

0 

0 

0 

0 

-2.366e-4 

0 

-8.614e-3 

0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 


= 


4.0710el 

0 

0 

0 

2.3101e-l 

0 

-2.S869e-l 

0 

0 

0 


4.0710el 

9.5278el 

0 

0 

-1.5935e-l 

1.268e-l 

-8.9161e-2 

0 

0 

0 


4.0710el 

5.8899el 

0 

0 

8.1846e-2 

-2.0525e-l 

2.3356e-l 

0 

0 

0 


4.0710el 

-5.8899el 

0 

0 

S.1846e-2 

2.0525e-l 

2.3356e-l 

0 

0 

0 


4.0710el 

-9.5278el 

0 

0 

-1.593e-l 

-1.268e-l 

-8.9161e-2 

0 

0 

0 


where 


and 


A = W 2 A 


B = 

^max 


(3.40) 


(3.41) 
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Using the specifications of the core, is as follows: 


4.3308e5 0 ••• 

0 4.3308e5 ' • . 
: •• 1 



1 

1.0602e2 

1.0602e2 

1.0602e2 

1 


0 


1 0 
0 1 


(3.42) 


The matrix A, which contains 


the dynamics of the open loop plant, has the 


following eigenvalues. 


59.2596 + Oj 
-59.2596 + Oj 
0+ 7.9717j 
0 - 7.9717j 
0 + 0.9556J 
0 - 0.9556j 
58.2942 + Oj 
-58.2942 + Oj 
9.7762 + Oj 
-9.7762 + Oj 


(3.43) 


There axe five pairs of eigenvalues, each of which can be associated with one or 
two degrees of freedom. As can be seen, three of these pairs axe unstable, and the 
other two axe marginally stable. The modes of the system are listed in table 3.3. 


23 



Mode # 

Eigenvalues 

Stability 

Degree of Freedom 

1 

± 59.26 rad/s 

Unstable 

x, 0 y (Axial , Pitch) 

2 

± 7.972 rad/s 

Stable Oscillatory 

x, 6 y (Axial, Pitch) 

3 

± 58.29 rad/s 

Unstable 

$ z (Yaw rotation) 

4 

± 0.956 rad/s 

Stable Oscillatory 

z (Vertical motion) 

5 

± 9.776 rad/s 

Unstable 

y ( Lateral motion) 


Table 3.3 Open loop modes of the suspended element 


The two most unstable eigenvalue pairs, modes one and three, are referred to 
as the “compass needle” modes; this represents the cores tendency to turn and 
align its ends with the unlike polarities. A sketch of the modes, in relation to the 
core’s motions is shown in figure 3.2. 



Vertical translation (stable) Lateral translation (unstable) 


Figure 3.2- The modes of the model 
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3.4 Coils and Power Amplifiers Modeling 

Up this point it was assumed that the coils were capable o! producing the 

magnetic field instantaneously. The coils are inductors, and inductors produce 
lags in the system. The power amplifiers are constant current sources based on 
their command input voltages; they are voltage to current converters. However, 
they cannot produce instantaneous infinite power to compensate for the lag in the 
coils. For an accurate model of the system, it is required to model the the coll- 

amplifier block. 

The basic circuit representation of an amplifier and a coil is shown in g 

3.3. 



R, 


Figure 3.3- Simplified amplifier and coil circuit diagram 


Simpie circuit analysis will show that the coil terminal voltage can be represented 
by the following equation: 

Vj = Ij (Rj + Lj s) + I 2 L 12 s + I 3 L 13 s + I 4 L 14 s + I 5 L 15 s (3.44) 
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The amplifiers are represented as having an output current feedback. Applying 
the Kir ch H off’s voltage law, V j can also be written as follows: 


Vj = K (V D1 - k I) 


(3.45) 


Equating equations 3.44 and 3.45, the relation between the current demand input 
to the amplifier to the coil current for coil one can be represented as: 


L l 12 l 13 l 14 l 15 J 


= - (Rj+ Kk) I, + K V D1 


(3.46) 


Applying the same procedure to all five coils and amplifiers, the overall coil- 
amplifier state-space model can be written as follows: 


r=Af+BV D (3.47) 

Assuming the coils have identical resistances, the A and B matrices are defined 
as follows: 

A = -(R + Kk) [ L J' 1 (3.48) 

B = K [ L j’ 1 (3.48) 

Since L- = Lj- , [L] is symmetric. Every coil has two adjacent and two non- 

adjacent neighboring coils. Due to the geometry of the array, the mutual 
inductances between all the adjacent coils are equal. Therefore, the mutual 
inductances between all the non-adjacent coils are also equal. 
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(3.49) 


— 


L 1 L 12 

L 13 

Ll4 

L 15 



L 12 L 2 

L 23 

L 24 

L 25 

— 

[L] = 

L 13 L 23 

L 3 

L 34 

L 35 



L 14 L 24 

L 34 

l 4 

L45 




L 15 L 25 

L 35 

L45 

4_ 


Numerical values for the coil parameters are given in table 2.1. To determine the 
values for K and k, the D.C. gain and the break frequency of the amplifier/coil 
combination is necessary. The D.C. gain is set to 3 A/V, and, from the frequency 
response measurements, the break frequency is estimated to be about 180Hz. 
This results in K=93.30 and k=0.325. 

Substituting numerical values into equation 3.46, the state-space model 
becomes: 

1138.2 62.34 10.10 10.10 62.34 I : 

62.34 -1138.2 62.34 10.10 10.10 I 2 

10.10 62.34 -1138.2 62.34 10.10 I 3 

10.10 10.10 62.34 -1138.2 62.34 I 4 

62.34 10.10 10.10 62.34 -1137.7 I 5 

3414.7 -187.0 -30.3 -30.3 -187.0 V D1 

-187.0 3414.7 -187.0 -30.3 -30.3 V D2 

-30.3 -187.0 3414.7 -187.0 -30.3 V D3 (3.50) 

-30.3 -30.3 -187.0 3414.7 -187.0 V D4 

-187.0 -30.3 -30.3 -187.0 3414.7 V D5 

The analysis of the system without some form of CAD software would be 
difficult, therefore the software MATLAB^^ will be utilized extensively. The 
state-space model for the coils and power supplies can be added to the system 
state space using “SERIES” command in MATLAB. 
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CHAPTER 4 


Compensator Design 

It was established in the previous chapter that the plant model is open-loop 
unstable. Some feedback control technique must be employed in order to achieve 
stable suspension. Several control schemes sure available to stabilize the system. 
Aside from the classical techniques, there are modern state feedback schemes such 
as Linear Quadratic Gaussian and Linear Quadratic Regulator. However, in order 
to prove the planar array concept, a simple and well-tested method, classical dual 
phase-advance compensator (DPA), was chosen first [20]. The dual phase-advance 
compensator technique has been successfully used in many magnetic suspension 
applications and is relatively simple to implement [21] [22]. Once the system is 
operational, other control schemes can be tried for their performance on this 
system. In this phase of the research no great effort has been made to maximize 
performance. The basic aim has been to make the system operational, and after 
implementation in hardware, to compare the actual system’s behavior to the 
mathematical model. This chapter demonstrates some basic approach used to 
design the compensators, and shows some step responses of the closed loop system. 

4.1 Decoupled System Behavior 

The decoupled motions of the suspended element can easily be deduced from 
the sensor signals. This provides the required signals for five degrees-of- freedom, 
which are x, y, z, 6 y , and 6 Z (refer to figure 3.1). These signals can then be 
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processed through a set of five independent compensators and fed back to position 
command input comparators. The errors from these comparators axe then used to 
drive the current amplifiers. A block diagram is illustrated in figure 4.1. 


S 

E 

N 

S 

0 
R 

1 

N 

P 

U 

T 

S 


Sensor 

1 Decouplers Compensators 



Figure 4.1 Controller block diagram 


Most magnetic suspension systems follow the same pattern of feedback and 
control, however the “mixer 11 stage in figure 4.1 is fairly unusual. The coil 
currents are not decoupled with respect to the degrees-of-freedom; each coil affects 
more than one degree-of-freedom. The decoupled position signals must be 
converted to coil current demand signals to produce the desired magnetic fields. 
This is done by linear combination of the coil currents through a 5 x 5 mixing 
matrix, also known as current allocation matrix, located just prior to the current 
amplifier inputs. In chapter six, it will be shown that, by switching through a 
series of these mixing matrices, the core would be made capable of 360 rotation 
in yaw. 
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The application of the DPA compensator, like many other controller design 
approaches, relies, to some extent, on previous knowledge of the application and 
may involve some trial- and-error [23]. The DPA compensator is basically two 
lead stages in cascade, and it is essentially a high-pass filter. In general, systems 
using permanent magnets or electromagnets without current control are inherently 
unstable [1] and have lag characteristics. They require an active control with 
some method of lead compensation to increase their crossover frequency, and 

hence the overall system’s bandwidth [23]. 

The plant model is a multi-input multi-output system, and in some cases it 
has coupled degrees-of-freedom. This makes analysis difficult using classical 
methods. However, a study of only one degree-of-freedom can give some useful 
information regarding the application of the dual phase-advance method to the 
full system. 

As described in the previous chapter, the pitch and yaw modes are the most 
unstable of the five modes, and are referred to as the “compass- needle modes . 
Out of these two compass -needle modes, pitch is coupled with the axial motion, 
but yaw is fairly independent of other degrees-of-freedom. For simplicity yaw will 
be used as a demonstration of the application of DPA compensator to this system. 

Equation 3.24 describes the dynamics of yaw motion. This equation can be 
written as following: 


0 


z 


VM X 

Ic 


( ' &Z + By) 


(4.1) 


Since it was assumed that the fields can be expressed in terms of linear functions 


of the coil currents, equation 4.1 can be written as. 


n _ VMx 
bz ~ Ic Imax 


(- LK X J I h + LKyJ I ) 


(4.2) 
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The above equation cam be linearized about the operating point, using a 
Taylor series expansion. Subtracting the linearization point, this results in the 
following equation: 


\ ~ ( [KJ r 0 I, + e, [KJ r + LKyJ I) (4.3) 

A c A max u 

The assumption was that the core is at zero position, therefore @ zq — 0- The row 

— * 

vector [K X J can be combined with the current vectors Ig/Imax f° rm the scalar 
Iq. In order to represent the five input currents to the system as a single 
command current, the row vector LKyJ is multiplied by the second column of the 
mixer matrix shown in equation 4.18. The resulting transfer function of the above 
equation can be represented as shown below: 


r „ 

W — T 

A yaw 


0.06 


A c 'Z _ T 

¥ M x 0 


(4.4) 


Substituting numerical values into the above transfer function will produce the 
following characteristic equation and transfer function: 

s 2 - 3.3982 X 10 3 = 0 


G 7n — 


2.3688 x 10 4 


Z P (s + 58.294) (s - 58.294) 


(4.5) 


In order to properly represent the single degree-of-freedom, it is necessary to 
include the lag due to the power amplifier and the coil responses. Through 
experimental measurement, the break frequency of the amplifier- coil combination 
has been found to be about 1130.9 rads/scc. The power amplifiers have a D.C. 
gain of 3 A/V. Neglecting the mutual inductances, the overall open-loop transfer 
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function can be represented as in equation 4.6. From the root locus of G Z p in 
figure 4.2 , it can be seen that the closed-loop system is unstable for all gains. 
Therefore, a compensator is needed for stability. 


8.03662e7 

Z P “ (s + 58.294) (s - 58.294) ( s + 1130.9) 


(4.6) 



Figure 4.2- Root locus of yaw degree-of-freedom (no compensator). 


4.2 Dual Phase Advance Compensator 

The aim of the compensator is to place all the closed-loop poles of the system 
in the left half-plane. As it will be shown, the DPA will accomplish this task 
satisfactorily. The general transfer function of a lead compensator is: 


H = a 


1 + ju/T 
1 + ju;aT 


a<l 


(4.7) 


The above function places a zero at the point 1/T and a pole at l/(aT). It is a 
common practice to let o ~ 0.1, which puts the pole of the compensator far 
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enough to the left to minimize its effects on the system dynamics while at the 
same time it is close enough to limit high frequency noise. The only factor that 
remains to determine is the break frequency 1/T. One method of selecting T, for 
a type 0 system, is to place the zero of the compensator over the second highest 
pole of the system [23]. This location, from the eigenvalues, is at a frequency 
between 9 to 10Hz (58 to 59 rads). The bode plot of the lead compensator 
described above and the root locus of the system with the compensator are shown 
in figures 4.3 and 4.4, respectively. 

In order to form a DP A compensator a second lead compensator is connected 
in series to the first. The equation for the dual phase advance compensator is 
basically the square of equation 4.7. Substituting 1/a = 10, the transfer function 
for the dual phase- advance is the following: 


H DPA - 8 


Og + 1/T) 2 
(ju; + 10 /T) 2 


(4.8) 


The root locus of the system with the DPA compensator is shown in figure 4.5. 
Compared to the single phase advance;, the DPA compensator may not seem 
much advantageous in the present case. This can be attributed to the current 
feedback in the amplifiers which increases the break frequency of the coils to 
1130.9 rads/sec. If the break frequency of the coil alone was used (R/L = 20.9 
rads/sec), the advantages of the DPA compensator would become more obvious. 
The DPA compensator is chosen here because of its popular application in 
magnetic suspension systems. 


4.3 Application of The DPA to All Five Dcgrccs-of-Frcedom 

The stabilizing technique given for the single degree-of-freedom system can be 
applied to all five degrees-of-freedom. However, to ease the process of analysis, 
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Figure 4.6- Step response in yaw for the selected gain 
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Figure 4.7- Plant and controller block diagram. 

The state-space models describing the plant and power amplifiers and coils have 
already been determined in previous chapter. The necessary step now is to 
determine the state-space model for five independent compensators to adequately 
stabilize the overall system. 

In order to select the compensator break frequencies for other degrees of 
freedom, the modes of the system should be examined. Again referring to table 
3.3, the dynamics of the pitch degree- of- freedom (open loop poles of ± 59.26 
rads/s) is very similar to that of yaw. It seems reasonable to use the same 
compensator values for pitch. From the three remaining modes, axial and vertical 
motions are marginally stable, and the unstable pole due to the lateral motion is 
very close to the imaginary axis. This allows for some flexibility in selecting the 
compensator parameters, since they are very close to being stable. An initial 
tendency would be to use similar compensator settings for all five degrees-of- 
freedom for simplicity, and this will be shown to be workable. 
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From the transfer function, one can construct the state-space model for a 


single compensator as follows: 



r 2 

1 


1 

Ac — 

T T 2 

*5Bc = 


1 

0 


0 


Cc = [2^ ijj£] <3)c = [ n 2 ] (4.9) 


Substituting the values selected for the yaw degree-of-freedom into the above 
state-space equations results in the following: 


Ac — 


-1.5385e3 -5.9172e5 


1 


'iBc - 


1 0 


0 


Cc = jjl.7906e5 -7.4964e7] «D c = [ 127.69] 

(4.10) 


By arranging five of the above models in parallel, arranged in a single state- 
space system, the basic compensator structure is complete and can be attached to 
the plant model. This can be easily accomplished by using the “APPEND” 
command in MATLAB^ 1 . The resulting compensator state-space model is as 
follows: 


.4 -4c = 


-1.53e3 -5.92e5 0 

10 0 0 

0 -1.53e3 -5.92e5 0 


0 


0 


10 0 0 

0 -1.53e3 -5.92e5 0 

10 0 0 

0 -1.53e3 -5.92e5 0 

1 0 0 0 

0 -1.53e3 -5.92e5 

1 0 


(4.11) 
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1 


0 


'Me = 


0 

0 

0 

0 


0 0 0 

... 0 ••• 

1 0 0 

...o ... 

0 1 0 

... 0 ... 

0 0 1 

... o ... 

0 0 0 

... o ... 


0 

0 

0 

1 


(4.11) 


U.79e5 


CCc = 


-7.49e7 

-1.79e5 -7.49e7 -O ' 

-1.79e5 -7.49e7 

•••O--. -1.79e5 -7.49e7 

-1.79e5 -7.49e7 


(4.12) 


mc T = [ 127.69 127.69 127.69 127.69 127.69] (4.13) 


The compensator’s state-space model is connected in the feedback path of the 
closed loop system. Again, this is accomplished by using the command 
“FEEDBACK” in MATLAB™. The feedback gain is a variable which can be 
selected based on the desired response. The gains on all degrees-of-freedom can be 
lumped in a diagonal “gain matrix” and added to the compensator. In simulation 
these gains are combined with the sensor gains. The sensor gains are determined 
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through some experimental measurements. These gains vary somewhat depending 
on the optical alignments and the adjustment of the electronics. Typical 
measured sensors gains in V/m are shown below: 

gsensor = [ 5077 5495 6024 6965 6560] (4.14) 

These gains are converted to gains for each degree of freedom using some 
approximations. The coupled sensor signals (sensors 1 and 3 and sensors 4 and 5) 
can be averaged and assumed to have the same gains. These averages can directly 
be used for linear motions (vertical and side motions). In the case of pitch and 
yaw, the distances between the two coupled sensors (sensors one and three for 
pitch and four and five for yaw) are used to derive angular displacements. Using 
simple geometry the following equation can be deduced: 

angular displacement = — - — ^ ^ ^ a J e j AV (4-15) 

The value in parentheses is the angular - gain for either pitch or yaw. A typical set 
of decoupled sensor gains is shown below: 

g ol = [ 162.SV/rad 183.9V/rad 4S82.lV/m 5269.7V/m 5137.SV/m] (4.16) 

These gains in conjunction with the compensator’s gains are arranged in the 
diagonal of the 5x5 gain matrix. The gain matrix is added to the model by 
simple multiplication to the output of the compensator state space equation. 

The forces and torques necessary to control the core are generated by a 
combination of currents in the coils. These currents are determined through a 
mixing matrix which transforms the position errors to currents necessary to 
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correct them. A general mixing matrix can be derived, based on 1 unit of field 
and field gradient in the position of the core. This produces a 5 x 5 matrix shown 
below: 


I 1D 1.8282e3 0 1.9652e2 0 -1.4687e2 

I 2D 2.3703e3 1.6446e3 -1.5901e2 1.1553e2 -4.5418el 

I 3D = 2.0347e3 1.0160e3 6.0751el -1.8689e2 1.1885e2 

I 4D 2.0347e3 -1.0160e3 6.0751el 1.8689e2 1.1885e2 

I 5D 2.3703e3 -1.6446e3 -1.5901e2 -1.1553e2 -4.5418el 

This matrix is normalized column-by-column for simplicity. The resulting matrix 
is as follows: 


0.7713 0 1 0 

1 1 -0.809 0.618 

0.768 0.618 0.309 -1 

0.768 -0.618 0.309 1 

1 -1 -0.809 -0.618 


4.4 Closed-Loop System Dynamics 

The closed-loop poles determine the stability of the system for a given set of 
gains. Since a root locus plot of a multi-input multi-output system is not easy to 
interpret, a study of gain variation of one degree-of-freedom at a time can be 
helpful. Through variation of gains for one degree-of-freedom at a time, a 
reasonable set of gains for all degrees-of-freedom was determined. These gains are 
shown below, and the resulting closed-loop poles are depicted in figure 4.S. 

gains = [ 0.1 0.1 0.5 0.5 0.5 ] (4.19) 
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The stable region of each degree-of-freedom was determined by varying the gains, 
one degree-of-freedom at a time, on either side of the operating point gains. 

These are listed in the table below: 


Degree of Freedom 

Low Gain Limit 

High Gain Limit 

Pitch 

0.01 

.15 

Yaw 

0.08 

.2 

Axial 

0.11 

.50 

Side 

0.21 

0.48 

Vertical 

0.12 

.51 


Table 4.1 Stability limits of the LAMSTF using the DP A 
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Figure 4.8- Closed-loop poles of the plant. 

The resulting step responses for every controlled degree-of-freedom are shown 
in figure 4.9. As it can be seen, they all have a reasonable damping and rise time. 
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Seconds 

(b) - Step response in y (side). 

Figure 4.9- Simulation step responses in all five degrees-of-freedom. 
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CHAPTER 5 


Analog Controller 

The major aim of this phase of the research has been to validate the concept 
of the planar array magnetic suspension system. Provisions had to be made to 
implement the previous chapter’s controller design into hardware. Even though a 
digital controller would be more appropriate for this application, due to the initial 
inaccessibility to a suitable digital computer, an analog version of the controller 
was constructed. The analog controller would be a bridge between the theory and 
the digital controller. The analog controller consists of three major stages, sensor 
decouplers, DP A compensators, and current allocation mixer. This chapter will 
describe the basic principles of the analog controller designed for this system. 

5.1 Sensor Decoupler 

As explained previously, four out of five degrees-of- freedom detected by the 
sensors are coupled. By simple summing and differencing appropriate sensor 
signals, the decoupling can be achieved. Differential amplifiers and summers are 
the two basic analog circuits used to perform this task. The generic circuit 
diagrams of these two stages are shown in figure 5.1. 

The sensor output voltages should range from 0.5V at full beam to 5.0V at no 
beam. However, these voltages deviate from ideal due to the lenses and sensor 
frame mis-ahgnmcnts and circuit component tolerances. The sensor signals are 
conditioned through a set of amplifiers to produce outputs ranging form -0.5V at 
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no beam to 10.5V at full beam. These voltages are the inputs to the analog 


controller. 


Sensor 

Inputs 



Pitch 

(Yaw) 


Sensor 

Inputs 



Vertical 

(side) 


Fig 5.1 Differential amplifier and summer. 


The summing of sensors one and three would produce the vertical motion 
signal, and summing sensors four and five produces the side motion signal. In 
order to produce a 0V to 10V signal for every degree of freedom, a gam of 0.5 is 

selected for the summers to average the summed inputs. 

The differencing of the same combination of the above sensors can give the 
angular motion of the core. Differencing sensors one and three produces the pitch 
signal, and differencing four and five results in the yaw signal. The gain in these 
stages are kept to unity. The sensitivity of each sensor channel is determined 
through some calibration procedure. 

The signal from sensor two represents the axial movement, and is not coupled 
with other degrees of freedom. Therefore, the axial signal passes through the 
decoupler stage unaffected. Vertical and side movement signals pass through 
inverters to correct for signal inversion in the adders. 
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5.2 Dual Phase Advance Compensator 

In direct correspondence with the simulation, the next stage would be to 
compensate the decoupled signals. The schematic diagram of a typical analog 
dual phase advance is illustrated in figure 5.2. 



-V 


D- 


r 4 R5 + V 

AAM VvVV WA a 

R 6 

Position 



Figure 5.2- A typical analog DPA schematic diagram. 


The corresponding equation of the phase advance, using resistor- capacitor network 
in the first stage, is as follows: 


_ 1 j- R 1 C 1 s 
n “ 1 + n s 


(5.1) 


The value of n can be shown to be: 


r 2 

u " Ri+R^ 


(5.2) 


The break frequencies of the compensator can be set by selecting suitable values 
for R, and C,. Since the two stages are identical, the same principals applies to 
components of the second stage C 2 , R„ and R*. Taking into consideration the 
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electronic aspects of the circuit, the following component values have been 
selected to place a zero at about 16Hz: Rj = R 7 = 100 kfl, R 2 = Rg = 10 kfl, 
and Cj = C 2 = 0.1 /if. With these components, the value of n=0.09. In the 
circuit the feedback resistor R 3 and R 9 mainly determine the circuit gain, and R 9 
is made variable for this reason. In addition to the gain control, a D.C. offset to 
the first op-amp act as the position command input. 

5.3 Mixer Stage 

The mixer stage is composed of a set of five summers, which combine the five 
compensated signals to form the coil current demand signals. A simplified circuit 
diagram forming the current demand signals is shown in figure 5.3. 

The calculated values of the resistors are mostly nonstandard. Therefore, 
variable resistors, adjusted for the desired values, were employed. Since the 
inputs to this stage are a combination of positive and negative polarity of the 
same signal, analog inverters were used to supply all the signals required. The 
outputs of the op-amps of this stage are directly fed to the power amplifiers. 


5.4 System Response 

The suspension of the model was successfully achieved. Figures 5.4 and 5.5 
are actual photos of the model during suspension. The performance of the analog 
controller was quite satisfactory. Step responses of this controller were recorded. 
These step responses along with the mathematical simulation results are shown in 
figures 5.6 through 5.10. For all degrees-of-freedom except pitch, the actual step 
responses closely match the simulation results. The pitch signal seems to be less 
damped that the simulated result. 
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Coil 1 



Coil 2 


Coil 3 


Coil 4 


Coil 5 


A - Axial 

Y - Yaw 

V - Vertical 
S - Side 

P - Pilch 


Figure 5.3 Current allocation (Mixer) network schematic. 
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Figure 5.6 - Analog controller step responses. 
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Position (mm) 


0.25 



(b) Step response in y (side). 



(c) - Step response in z (vertical). 
Figure 5.6- Continued. 


5 



Angle (deg) 



(d) - Step response in By (pitch). 



(e) - Step response in 8 Z (yaw). 
Figure 5.6 - Continued. 
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Figure 5.7 illustrates the step responses in one degree-of-freedom, with its 
effect on all the other degrees-of-freedom. The coupling between pitch and axial 

motions can clearly be seen. 

It should be noted that the step size in these results are quite small. Larger 
steps can introduce other sources of error. In the first place, the sensors have a 
very small range of operation ( ± 3mm). Since the sensor response curves show 
nonlinearity at either extreme of its operating range, large steps can push the core 
to these limits, causing deviation from theory. Further, most of the modeling was 
based on the assumption that the model remains at zero position. Therefore, the 
steps should be reasonably small to keep the core as close to its operating point as 
possible, while it is large enough to minimize noise interference. 



(a) - x (axial). 

Figure 5.7 - Coupling among the degrees-of-freedom. 
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Time (sec) 


(c) - z (vertical). 
Figure 5.7 - Continued. 
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(d) - ffy (pitch). 



(e) - 6 Z (yaw). 
Figure 5.7 - Continued. 
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CHAPTER 6 


Digital Controller 

The incorporation of a digital controller to the system was a necessary step in 
order to study the system’s full capabilities. Since the system is a multi-input 
multi-output, coupled in most cases, it is not really suited for a fully analog 
controller. A digital controller would offer more flexibility and accuracy [24]. In 
the case of LAMSTF, one of its major design features is its 360° yaw rotation 
capability. As stated previously, yaw rotation requires an almost continuous 
change of the mixing matrix. This can easily be implemented in a control 
algorithm, where-as it would require a complex circuit in the analog controller. 

An Intel 386 based personal computer was available, so a fully digital 
controller was implemented using this machine. C programming language is used 
to develop the controller software since it is a versatile language and is commonly 
used for many scientific applications. Added graphical displays and controls allow 
monitoring, and change of controller variables in real time. This chapter describes 
the present digital controller setup and the software algorithm. 

6.1 Hardware Description 

An A/D converter board, a D/A converter board, and a timer board are 
installed in a Dell 386 (33 MHz) computer. The timer board is used in the 
present setup as an interrupt source to the computer’s processor to execute an 
interrupt service routine. 
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6.1.1 Analog to Digital Conversion 

The A/D board is a Keitkley Metrabyte DAS-40. It has a maximum speed of 
250,000 samples per second in single channel mode. It processes the five sensor 
signals in single-ended multiplexed input format. It is programmed to perform 
direct I/O commands rather than direct memory access (DMA). The data 
processing sequence, acquiring samples from the five channels almost 
instantaneously and processing them before the next batch, was easier to 
implement using direct I/O technique. The board contains a pacer clock and can 
generate interrupts. However, no interrupts were used from this board because of 
insufficient on-board timer capabilities. 

The A/D board is set to input voltage in the range 0-10V. For a 12-bit data 
conversion, a 10V range produces 2.44 mV/bit resolution. 

6.1.2 Digital to Analog Conversion 

The processed data is converted back to analog signals via a Iveithley 
Metrabyte DDA-06 digital to analog converter board. This board contains six 
independent 12-bit D/A channels*, only five of them are utilized presently. The 
programming of this board is straight forward using I/O instructions. Data is 
simply written to lower and higher bytes of each individual D/A, which are 
located consecutively from the base address of the board. 

The DDA-06 has a selectable analog output range. Since the power 
amplifiers require an input range of ±10V, the board is set to conform to this 
range. The 20V output range produces a resolution of 4.88 mV/bit. 

6.1.3 Timer Board 

One necessary requirement of the controller is to process data at a constant 
sample rate. If the program is simple and short, a crude method could be to add 
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a delay statement in the program to set the sampling rate. However, a more 
effective and accurate method is to use an interrupt service routine (ISR). In the 
early version of the digital controller used for LAMSTF, no interrupt was used. 
Successful suspensions were attempted, however implementation of an interrupt 
was still necessary for better performance. After the installation of the DAS-40, a 
timer board was used mainly as an interrupt generator. 

The board used, a Tecmar Lab Master, is software programmable to produce 
a range of timer frequencies. The signal from the timer is setup to produce an 
interrupt request to the computer processor. The interrupt request table is 
programmed to service the DAS-40 board. With this configuration, the Lab 
Master generates interrupts at a predetermined frequency. The computer 
acknowledges the interrupt by calling the ISR, pointed by the interrupt level. 

6.2 Discrete-Time Dual Phase Advance 

The implementation of the DPA compensator requires conversion of the 
continuous-time design to discrete-time. Equation 4.8 represents the Laplace form 
of the DPA. To transform this equation to z domain, the bilinear transformation, 
often referred to as the Tustin’s method, is used [24] [25] . This transformation is 
shown in below: 


s 


_ 2 z - 1 
“ T z + 1 


( 6 . 1 ) 


Replacing u with s in equation 4.8, and using the above transformation results in 
the following discrete time DPA filter equation: 


Y k = aifc + bU M + cU k . 2 - dY k ., - eY„. 2 


( 6 . 2 ) 
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where the coefficients are as follows: 


dt 2 + 

4nT dt + 4n 2 T 2 

dt 2 

+ 4Tdt + 4 T 2 


2 dt 2 - 8n 2 T 2 

= d? 

+ 4Tdt + 4 T 2 

dt 2 - 

4nT dt + 4n 2 T 2 

' dt 2 

+ 4Tdt + 4 T 2 


2 dt 2 - 8T 2 

= d? 

+ 4Tdt + 4 T 2 

_dt 2 

- 4T dt + 4T 2 

dt 2 

+ 4Tdt + 4 T 2 


(0.3) 


(6.4) 


(6.5) 


( 6 . 6 ) 


(6.7) 


For a given sample rate and compensator break frequency all the above 
coefficients are constants. 


6.3 Program Algorithm 

The actual controller program is quite compact. However, many features 
have been added to facilitate real time observation and modification. Since the 
controller block is an interrupt service routine, it runs independently from the 
main program. The variables used in the ISR are declared as global in the main, 
therefore both the main and ISR can access them. 
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6.3.1 User Interface 

The main runs continuously in a loop and monitors keyboard inputs and 
responds to the request made by the user. The ability to change parameters such 
as loop gain or the core’s position, while in suspension, can be of great assistance 
in studying the behavior of the plant. The program allows the user to adjust the 
gains while the core is in suspension, and can display step responses in any degree 
of freedom. The graphical interface, in a form of a multi-channel oscilloscope, can 
plot all the core’s movements in real time. 

6.3.2 Dual Phase Advance 

The discrete-time dual phase advance formula, shown in equation 6.2.2, is 
directly implemented in the program. All the coefficients are functions of the 
compensator’s break frequency and the sample rate. The value for n has been set 
10.0, as determined in the compensator’s design. Based on a sample frequency of 
400Hz, and the compensators break frequency of 17Hz, the DP A discrete equation 
becomes as follows: 

Y k = 23.56 U k - 36.02 U k4 + 13.77 U k _ 2 - 0.287 Y k-1 - 0.0206 Y k _ 2 (6.8) 

Since there are five independent channels, the above equation is executed five 
times in each sample period. 

6.3.3 Interrupt Service Routine 

The ISR, when initiated by the timers interrupt signal, performs five analog 
to digital conversion from the five sensor signals. It then performs the decoupling 
of the sensor signals by simple addition, subtraction, and scaling. The decoupled 
signals are compensated through the discrete DP A equation. The five 
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compensated signals are mixed through the current allocation matrix and output 
to the D/A board. The ISR supplies the appropriate acknowledge signals to the 
timer board and the computer interrupt handler. 

6.4 System Response 

The step responses and their corresponding gains are recorded in 
MATLAB™ readable format files. These responses are compared with the 
analog controller and the mathematical simulation responses. Figure 6.1 
illustrates these responses for all five degrees of freedom. The simulation and the 
analog responses are superimposed on these plots for comparison. As with the 
analog controller, the digital controller’s response closely resembles the simulation. 
Here again the pitch seems under damped compared to the simulated result. 



(a) - Step responses in x (axial). 
Figure 6.1- Digital controller step responses. 
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Position (mm) 


'.25 


0.3 


Time (sec) 

(b) - Step response in y (side). 



(c) - Step response in z (vertical) 
Figure 6.1- Continued. 
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Angle (deg) 



(d) - Step response in 0y (pitch). 







6.5 Large Angle Yaw Rotation 

One of the major point of interest in this design has been the potential to 
rotate the core over a range of 360° in yaw, while in suspension. This should be 
accomplished by rotating the sensor frame about the z axis. The five 
electromagnets, can then produce the fields and gradients necessary for suspension 
in any orientation in the x-y plane. This requires proper distribution of currents 
to the coils through the mixing matrix. Through some simple programming 
modifications this feature of LAMSTF was successfully demonstrated. 

6.5.1 The Current Distribution Matrix 

Considering the symmetric geometry of the planar array, after 36° of rotation, 
the negative x axis intersects the axis of coil four. At this configuration coil four 
effectively becomes a negative of coil one, coil five a negative of coil two, and so 
on. Therefore the mixing matrix at 36° is identical to that at 0 , with its rows 
rearranged to point to their new coil sequence. This pattern repeats every 36°; at 
72° coil two becomes as coil one. Using this property, determination of the mixing 
matrices can be limited to only six. An array of 5x5 mixing matrices were 
calculated at 6° intervals, from 0° to 36°. Again the finite element method 
software, VF/GFUN, was used to generate the elements of these matrices, and 
every column was normalized individually. The resulting six matrices were copied 
and modified to form 60 matrices in a full 360° rotation. The 5 x 5 x 60 matrix is 
entered into the program through a data file during the initialization of the 
controller program. 

The basic idea is that, by interpolating between every adjacent matrix, finer 
matrix transition could be achieved. A simple linear interpolation routine is 
implemented. The interpolation equation used is as follows: 
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ffi ij = m ij[k-l] + d Kjk - m ij[k-l]> 


(0.9) 


and 

j _ ^actual — ^[k-1] 

U *o 

D 

Vu = (% a! ) 

The interpolated mixer elements m - are sent to the ISR to replace the previous 
values. 

Provisions were made for negative angles and angles beyond ± 360°. This 
was simply a matrix index manipulation to reverse the indices for negative angles, 
and to point to zero index after a 360° rotation. 

6.5.2 Initial Current Setting 

Besides the mixing matrix, the initial current vector has to be modified for 
each new yaw position. The expectation was that the initial currents should 
follow a sinusoidal trend, with every coil current shifted by 72° in phase (see figure 
6.2). To accomplish this, the maximum amplitude was defined to be the current 
value for coil one at zero angle yaw. All coil current values are calculated by 
taking the cosine of the angle plus their phase shift. Coil one has 0° phase shift, 
coil two 72° phase shift, and so on. This would produce a 0° yaw suspension 
current set as follow: 


( 6 . 10 ) 

( 6 . 11 ) 


I 0 = [ -14.5A -4.5A 11.8A 11.8A -4.5A ] (6.12) 

In the program it was found that using the cosine function continuously would 
encounter program errors at times; perhaps due to interrupt conflicts. For this 
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reason and to improve calculation speed, cosine values for a range of values are 
calculated and stored in an array. As the new position is sensed, the index to 
point to the corresponding cosine array element is determined. 



Figure 6.2- Current trend in the five coils for a 360° yaw rotation. 


6.5.3 Mixer Switching Technique 

Now that the provisions have been made to select a mixing matrix and an 
initial current set, a yaw angle input to the program is necessary. In the initial 
testing, the sensor frame was rotated and the yaw angle was manually increased 
to track the core. A precise method would be to attach an encoder to the sensor 
frame to monitor the sensor frame’s position. However, since the controller is of 
type zero, and there is a steady state error in all degrees of freedom, this error 
may be used as a crude tracking signal. The yaw error signal is a low-amplitude 
random signal superimposed on a D.C. value. With the core suspended, the 
steady state error (the D.C. value) tends to increase or decrease as the sensor 
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frame is rotated. The core initially is suspended at a known yaw angle. As the 
error magnitude crosses a critical level with the rotation of the sensor frame, the 
yaw angle is stepped by one unit; presently a unit is set to a half a degree. This 
allows the program to keep track of the yaw angle without an actual feedback 
from the hardware. In the program the error in yaw is continuously monitored, 
once per loop. If the critical error level in detected a subroutine is called to 
determine the new mixing matrix and zero position currents. The ISR has 
immediate access to the calculated values. 

One important factor in using the above technique is the random noise 
interference. Care must be taken not to allow instantaneous large magnitudes in 
the noise to be a cause of yaw angle change. A simple low-pass filter is employed 
to eliminate some of effects of the noise. For this purpose, a moving average filter 
was used. The equation for the filter used is as follows: 

Y k = § <Y k + Yu + Y k . 2 ) (613) 

The performance of the above filter seemed fairly satisfactory. 

A series of photos of the suspended element at 30 degrees steps in yaw angle, 
from 0° to 120°, are shown in figure 6.3. 
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CHAPTER 7 


Discussion 

The overall performance of LAMSTF proved to be quite satisfactory. Even 
though its unique design had never been tested in hardware, successful operation 
was achieved without major difficulties. The system proved to be fairly robust. 

It would work well with mis-alignments in the sensor frame or small 
displacements from its designed operating point. The system response seems to 
match the simulated results very closely, except in the case of pitch which is a 
little under damped. The actual cause for this discrepancy has not yet been 
confirmed. However, some inaccuracies were discovered in the hardware which 
may contribute to this problem. It was found that the core suspends slightly 
above its designed operating point due to the position of the sensor frame. The 
fields and the field gradients, used in the simulation, have been calculated based 
on the designed operating point. This may cause noticeable error in more 
unstable modes such as the pitch. Another hardware inaccuracy was found in the 
position of the coils in the array. The radius of the coil array is about 1/8” larger 
than the actual design. This would result in lower field intensity at the operating 
point. New hardware is under construction to eliminate these errors. The eddy 
currents in the base plate are another potential source of error in the results. 
Some study of the effect of the eddy currents, induced in the base plate, directly 
under each coil, suggested negligible effect on the system. However, more 
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investigation should be done on the eddy currents generated by combination of 

coils, and their effects on the system response. 

The digital controller proved to be very useful to the project, since it 
enhances the ability to make accurate measurements of the system’s response, and 
makes the yaw rotation possible. The use of the ISR greatly increases the 
capabilities of the program. Since the main program itself does not have to run 
the controller, it can perform many added features such as the graphics display 
and the yaw rotation calculations, without affecting the sample rate. 

The method utilized in switching between yaw angles can be refined to 
produce smoother transitions, without the direct use of the error in yaw. One 
proposed method is to use the current distribution in the coils as a mean of yaw 
angle detection. However, more studies need to be performed to establish its 

feasibility. 

During the operation of the LAMSTF, structural vibration has been observed 
at higher controller gains. The frame along with the sensor electronics mounted 
on them are subject to the magnetic fields from the coils. The changing magnetic 
fields can induce current in the conductors. The structural vibration may be 
attributed to induction of the changing magnetic fields to the sensor and LED 
wiring. These unwanted signals are carried to the controller as a false position 
signal which produces correction signals from the controller. The correction 
signals are fed back to the current amplifiers, which produce more changing 
magnetic fields, causing oscillations. Some steps need to be taken to shield the 
cables and sensors from the magnetic fields, or to position the sensors further 
away from the coils. The sensor frame is mounted on bakelite studs which are 
directly bolted to the iron cores in the coils. As the current changes in the coils, 
the iron core, which behaves like a mass and a spring fastened to the base plate, 
moves and transmits vibrations to the sensor frame. These vibrations are again 
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carried to the controller as a position change from the suspended element, causing 
an oscillation. Again a new sensor frame mount, decoupled from the coils, » 

being constructed. 
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CHAPTER 8 


Conclusion 


The principle of the planar array has been proven in practice. The existing 
hardware was made operational using an analog and a digital controller. A simple 
and well tested controller approach, using the dual phase advance controller, was 
employed. The ability of the system to sustain suspension in a full 3G0‘ yaw 

rotation was demonstrated. 

One of the decoupled degrees-of-freedom, yaw, was analyzed using the DPA 
compensator. The design was successfully implemented in all five degrees-of- 


freedom. 

An analog controller, using op-amps, was designed and built. Actual 
suspension of the core was achieved without any major difficulties. Step responses 
from the analog controller were recorded and compared to the simulated results. 
All degrees-of-freedom were found to match closely to the simulation except the 

pitch degree-of-freedom which seemed slightly under damped. 

A 386 based personal computer, equipped with an A/D, a D/A, and a tuner, 
was used to develop a digital controller for the LAMSTF. Using the C 
programing language, a control software was developed for the system. The 
software utilizes an ISR to process the control algorithm. This increases the 
capabilities of the program to perform other tasks such as useful user interfacing. 
The software allows viewing and changing of the suspended element positions 
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graphically in real tune. The user is able to change the controller ga,n and view 
and record step responses. 

Step responses of the system, using the digital controller, were compared to 
the analog and s.mulated results. Like the analog controller, the digttal controiler 
showed a close match to the simulation, except in the pitch degree-freedom. 

One of the major aims of the LAMSTF, to demonstrate the 360 yaw 
rotation, was accomplished. A series of current distribution matr.ces at 6 
intervals were calculated and used in the program for the yaw rotat.on capabrhty. 
The program uses a linear interpolating scheme to calculate finer mixing matrrx 
components between the 6' emulated steps. A sinusorda. aero position suspense 
current trend for the yaw rotation was proven to work in practice. 
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Circuit Diagrams 
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Sensor 

Inputs 


1(4) R i 
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Vertical 

(side) 


Summing amplifiers 
Rj = R 2 = 10 kQ, R 3 = 5 kQ 


Sensor 

Inputs 


r 3 



Pitch 

(Yaw) 


Differencing amplifiers 


Rj= R 2 = R 3 = R 4 — 25 kQ 
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R 6 

Position 


Dual phase advance circuits 


Ej = R ? = 100 kfl 
R 2 = Rg = 10 kfi 
R 3 = 56 kD 
R 4 = Rg = 0 ft 
R g = 10 kft 

c x = c 2 = 0.1 n f 

Op-amps LF-353 
±V = ±5 V 
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Mixer circuit diagram 
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= 16.18 kft 


R^ — R 2 — 20 kO 
R f = 10 kn 
R 3 = 10 kfi 
R 4 = 10 kfl 
R 5 = 12.96 kn 
R 6 = 12.31 kU 
R ? = 16.18 kfl 
Rg = 10 kfi 
R 9 = 32.36 kQ 
RlO — 10 kfi 
R n = 32.36 kCl 

r 12 = 10 kn 

R 13 = 16.18 kf l 
R u = 12.31 kn 
R 15 = 13.02 kn 
R 16 = 32.36 kn 

r 17 = 10 kn 


R 18 

R 19 = 12.32 kn 
R2 q = 13.02 kn 
R^ = 12.31 kn 
R 22 = 16.18 kn 
r^ 3 = 10 kn 
R 24 = 32.36 kn 
r 25 = 10 kn 
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Appendix B. 


Program Listing 
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/****************************** ********************************^*+***/ 
/* L.A.M.S.T.F. */ 

A (Large Angle Magnetic Suspention Test Fixture) */ 

/* Controller program for the five degrees of freedom magnetic */ 

/* suspension system, at NASA Langley Hampton, Virginia. */ 

/* Program By: Mehran Ghofrani */ 

/* Old Dominion University */ 

/**** ************************* ************** ***************** ********* / 
#includc <graph.h> 

^include <stdio.h> 

#include <conio.h> 

#include <math.h> 

#include <float.h> 

#include <dos.h> 

#include <bios.h> 

#includc <signal.h> 

#include <stdlib.h> 

#include <malloc.h> 

#definc Address 512 /* A/D base address */ 

^define ADC_2 544 /* Timer board Address */ 

^define DDAbase 81C /* D/A base address */ 

#define UP 72 
#definc DOWN 80 
# define LEFT 75 
#definc RIGHT 77 
#dcfine ENTER 28 
#define ESC 27 
#definc FI 59 
#define F2 CO 
#define F4 62 
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#define F5 63 
#define F6 64 
#define F9 67 
#define F10 68 
#define pi 3.14159 
#define On 1 
#define Off 0 

/***% 4 ^*** *********************************************************/ 
#pragma intrinsic(outp,inp) 

/* External Mode call (Function ) Prototype */ 
extern mscl_das40(int*,int*,inU); 

#define Inport 512 

/* das-40 variables */ 
int mode, flag, params[10]; 

/* Pointers to Allocated ram Bufs */ 
unsigned int *DM A_buf,*bufoffset; 

unsigned int chan=10; 

/* Channel and Gain Array to use by Mode 2 */ 
int chans[5] = {0,l,2,3,4}; 
int gains[5] = {0,0,0,0,0}; 

int far *chans_ptr; 
int far *gains_ptr; 

/*^ ************************************** 
unsigned int adcsr; 
int dec, sampler; 
int y 1 l,xl,samplrate,diviser; 
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int intnum— OxOd; /* interrupt vector number */ 

int input, k j,num,plotcolor=0,datcolor= 15; 

int ii,i,l,x,y,chd,olddat[500][5]; 

int zoom=l,ang=0; 

int positionsign,gainupdown,trig; 

int dec,tmp[5]={53,101,149,197,245),kv,ix=25; 

double al l,a,b,c,d,e,f,current[5],savdat[5][500]; 

double v,vl[25],v2[25],vsensor[5],initialoffset[5]={4.86,1.631,-4.133,-4.133,1.631); 
double offset[5]={4.86, 1.631,-4.133,-4. 133,1.631}; 

double gain[5] = {.5,.5,.5,.l,.08),gainstep=.001,position[5],positionstep=.l; 
double mix[5][5]={ { 1.0,0.0,-1.0,0.625,0.0}, 

{-0.809, 0.618,-0.309, 1.0, 1.0), 

{ 0.309,-1.0,0.809,0.768,0.618), 

{ 0.309,1.0,0.809,0.768,-0.618), 

{-0.809,-0.618,-0.309,1.0,-1.0}); 


double mixall[5][5][61],yawangle=0,yawanglestep=0.5,filt[5],autoyaw=:0; 

double cosdat[800]; 

int maxnum,yawerrorlimit; 

char ch, chl,ch2, plotmode, loop; 

int rota=0; 

long backc; 

/******************************************************************/ 

void (..interrupt _far *oldnum)(void); 
void _intcrrupt _far datin(void); 

/****** *^********^ *******************************************♦****/ 

void process_error(void); 
void initialize(void); 
void oscilloscopc(void); 
void timerset(void); 
void adcinitialize(void); 
void plotdat(void); 
void keyboard(void); 
void shutdown(void); 
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void outdat(void); 
void gainplot(void); 
void positionplot(void); 
void trigplot(void); 
void compensator(void); 
void timersetup(void); 
void acknowledge(void); 
void savedat(void); 
void getdat(void); 
void newmixer(void); 
void cosmak(void); 
void beactive(void); 


main() 

{ 

/ ****** ************* ********************* **************************/ 

/* ISR vector setup */ 

/* ******************** *******************************************/ 
oldnum=_dos__getvect(intnum); /* OxOd IRQ-5 */ 

_disable(); 

_dos_setvect(intnum,datin); 

__enable(); 

outp(0x21,0x00); 

outp(0x20,0x20); 

_setvideomode(_ VRES1GCOLOR); /*select video configuration */ 

/************************ ♦♦♦♦♦♦♦♦♦*^^+++t******************************/ 

cosmak(); 

getdat(); 

adcinitializeQ; /* Initialize the A/D converter board */ 
prints” Enter Sample rate Please : ”); 
scan f( r, %d r \&;sam pirate); /* Get the sampling rate */ 
initial ize( ) ; /* Compute The compensators parameters */ 

oscilloscopeQ; /* Display the Controller Screen */ 
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timersetup(); /* Set timer to interrupt at sample-rate */ 

/******* *******^* ************************************************ ******/ 
/* Controller loop */ 


ch=ESC; 

whiIe(chl!=ESC) 

{ 

_setcolor(4); 

_rectangle(_GFILLINTERIOR,550,420,G37,477); 

_settextposition(28,71); 

printf(”RUNNING”); 

_settextposition(29,71); 
printf(”ESC- quit”); 
acknowledge(); 


while(ch!=ESC) 

{ 


keyboard(); /* Check for user input */ 

filt[4]=filt[3]; 

filt[3]=filt[2]; 

filt[2]=filt[l]; 

filt[l]=filt[0]; 

filt[0]=vl[14]; 

autoyaw=.5*(filt(0]+filt[l]); 
_settextposition(28,64); 
printf(”%5.2r, autoyaw); 


if(rota==l) 

{ 


if(autoyaw>=2) 

{ 

yawangle^yawangle+yawanglestep; 

newmixer(); 
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yawangle=yawangle+yawanglestcp; 

newmixer(); 

} 

if(autoyaw<=-2) 

{ 

yawangle=yawangle-yawanglestep; 

newmixer(); 

yawangle=yawangle-yawanglestep; 

newmixer(); 

} 

} 

for(j=0u<=4;++j) 

{ 

v=vl[2+3*j]; 

if(sampler<=2) 

{ _setco!or( 14); 

_rectanglc(_GFILLINTER10R,000,345,G20,340); 

} 

else 

if(sampler>200) 

{ __setcolor(l); 

_rectangle(_GFILLINTERIOR,G00,345,620,340); 

} 


if(chd!=0) 

{ 

if(! trig || ix<474) 

{ 

if(plotmoclc==’a’) plotdat(); 
if(plotmode==V) 

{ 

switch(ch2) 

{ 

case V: if(j ==0) trigplot(); 
break; 

case Y: if(j==l) trigplolQ; 
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break; 

case V: if(j==2) trigplot(); 
break; 

case ’m’: if(j==3) trigplot(); 
break; 

case V: if(j==4) trigplot(); 
break; 


/*********************************************************♦*****/ 

if(trig==0) 

if(ix>=475) ix=25;/* reset screen position to begining when at end */ 
if(ix<=:475) ix++; 

/* screen horizontal advance chk plotdat */ 

} 

_setcolor(2); 

.rectangle(_GFILLINTERIOR, 550,420, 637,477); 

_settcxtposition(28,7 1 ); 

_outtext(’ 1 R-Run” ); 

_settextposition(29,7 1 ); 

_outtext(” ESC-exit” ); 

ch=V; 

chl=getcli(); 

} 

/********************************************** ********** ************/ 
_clearscrecn(_GCLEARSCREEN); 

__settextposition( 1, 1 ); 
printf(”The gains are:\n”); 
for(j=0;j<=4;++j) 
printf(”Gain[%d]=%8.5f\n" j,gain[j]); 

_settextposition(20,30); 

/*******************************************************************/ 
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_setvideomode(_DEFAULTMODE); 
beactive(); /* keep the controller running */ 

} 

/************** — end of main *******************************/ 

/* oscilloscope: signal display screen setup */ 
void oscilloscope(void) 

{ 

int lldj,gainstart,posibar; 
j* initialization of the screen clear array */ 
for(ll=0;ll<=5;++II) 

{ 

for(jj=0 <=500;-|--hjj ) 
olddat[jj][ll]=20; 

} 

j* display of the oscilloscope screen */ 

__clearscreen(_GCLEARSCREEN); 

_setcolor(13); 

_rectangle(_GBORDER,0,O,639,479); 

_setcolor(plotcolor); 

_rectangle(_GFILLINTER10R,20,5,480,290); 

_settextposition(4,2); 

printffX"); 

__settextposition(7,2); 
printff Y"); 

_settextposition(10,2); 

printffZ*); 

_settextposition(13,2); 

priiUffM”); 

_settextposit ion (16,2); 
printfCN”); 

_setcolor(7); 

for(H=52;ll<=244;ll= 11+48) 

{ 

_moveto(19,H); 

lincto(24,ll); 
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_moveto(476,ll); 

_lineto(484,ll); 

} 


/♦ Gain control knobs Display */ 
_setcolor(8); 


backc=8; 

_setbkcolor(backc); 

_rectangle(_GFILLINTERIOIl,2,300,480,478); 

_settextposition(20,2); 

_settextcolor(14); 

_outtext(” Feedback gain contror); 
_settextposition(20,40); 

_outtext(”Position Control”); 

_setcolor(5); 

jj=0; 


for(ll=2 l;ll<=29;ll=ll-f-2) /* lableing the gain knobs */ 

{ 


_settextposition( 11,27); 
printf(”%4.3r,gain[jj]); 
jj++; 


_settextposition(ll,4); 

printf(”0'”); 

} 

for(ll=320;ll<=448;ll=ll+32) /* gain control bar display */ 

_rectangle(_GFILLINTERIOR, 42, II, 195,11+20); 
jj=0; 

for(ll=320;ll<=448;ll=ll+32) /* Presetting gain display */ 

{ /♦ on the screen */ 

gainstart=(int)(gain[jj]*80)+40; 

_sctcolor(7); 

_rectangle(_GFILLINTERIOR,40,ll,gainstart+3, 11+20); 

++jj; 

} 

/* display of position control knobs */ 
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_setcolor(4); 

for(ll=320;ll<=448;ll=ll+32) /♦ position control bar display */ 

_rectangle(_GFILLINTERIOR, 310, 11, 460, 11+20); 

_setcolor(10); 

jj=0; 

for(ll=320;ll<=448;ll=ll+32) 

{ 

posibar=385+(int)(position[jj]*75); 

_rectangle(_GFILLINTERIOIl,posibar,ll,posibar+Ul+20); 

++jj; 

} 

/*******♦♦******************************/ 

/* labling of gain knob display */ 

_settextposition(2 1 ,2); 

_outtext(”X”); /* x or axial */ 

_scttextposition(23,2); 

_outtext(”Y”); /* y or side */ 

_settcxtposition(25,2); 

_outtext(”Z”); /* z or vertical */ 

_settcxtposition(27,2); 

_outtext(”M”); /* M - pith movement */ 
_settcxtposition(29,2); 

_outtext(”N”); /*N - yaw movement */ 

_settextposition(2,62); 

/************************************/ 

/* Display of options */ 

printf(”E- enable plot”); 

_settextposition(3,62); 
printf(”D- disable plot”); 

_settextposition(5,62); 
printf(” Select Gain ”); 

_settextposition(G,G2); 
printf(”X- gain of x”); 

_scttextposition(7,62); 
printf(”Y- gain of y”) ; 

_settextposition(8,62); 
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printf(”Z- gain of z”) ; 
_settextposition(9,62); 
printf(”M- gain of pitch”) ; 
_settextposition( 10,62); 

printf(”N- gain of yaw”) ; 
_settextposition( 1 1 ,62) ; 
printf(”S - single plot”); 
_settextposition(12,62); 
printf(” A - all plots”); 
_settextposition( 13,62); 
printf(”T - triggered ”); 
_settcxtposition( 14,62); 
printf(”C - continuous”); 
_settextposition( 15,62); 
printf(”Fl- unzoom plot”); 
_settextposition( 16,62); 

printf(”F2- zoom plot”); 
_settextposition( 17,62); 
prin tf(”F4- Save data”); 


} 

/♦♦♦t********************************************************** 

/* keyboard: User interaction through keyboard */ 

void keyboard(void) 

{ 


*********/ 


char chin; 


if(kbhit()!=0) 

{ 

chin=getch(); 

switch(chin) 

{ 

case ’X’-.casc V: ch2=’x’; 


_setcolor(8); 

_rectanglc(_GFlLLINTERIOR,35,320,39,478); 

_setcolor(12); 

_rectanglc(_GFILLlNTER10R,35,320,39,340); 
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if(plotmode==y) 

{ 

_setcolor(plotcolor); 

_rectangle(_GFILLINTER10R,20,5,480,290); 

} 

break; 

case ’Y’icase ’y’ : ch2=’y’; 

_setcolor(8); 

__rectangle(_GFILLINTER10R,35,320,39,478); 

_setcolor(12); 

_rectangle(_GFILLINTERIOR,35,352,39,372); 

if(plotmode==V) 

< 

_setcolor( plotcolor) ; 

_rectangle(_GFILLINTERIOR, 20, 5,480, 290); 

} 

break; 

case ’Z’xase V: ch2=V; 

_sctcolor(8); 

_rcctangIe(_GFILLINTER10R,35,320,39,478); 

_sctcolor(12); 

_rectangle(_GFlLLINTERIOR,35,384,39,404); 

if(plotmodc==V) 

{ 

_setcolor(plotcolor); 

_rectanglc(_GFILLINTERIOR, 20, 5, 480,290); 

} 

break; 

case ’M’:case ’m’: ch2=’m’; 

_setcolor(8); 

_rectangle(__GFlLLINTERIOR,35,320,39,478); 

_sctcolor(12); 

_rectangle(_GFlLLINTERIOR, 35, 410, 39,436); 
if(plotmode==V) 

{ 

_setcolor(plotcolor); 
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_rectangle(_GFILLINTERIOR,20,5,480,290); 

} 

break; 

case ’N’:case V: ch2=’n’; 

_setcolor(8); 

__rectangle(_GFILLINTERIOR,35,320,39,478); 

_setcolor(12); 

_rectangle(_GF!LLINTERIOR,35,448,39,468); 

if(plotmode=:=V) 

{ 

_setcolor(plotcolor); 

_rectangle(_GFILLINTERIOR,20,5,480,290); 

} 

break; 

case ’S’: case ’s’: plotmodc=:V; 
_setcolor(plotcolor); 

_rcctangle(_GFILLlNTERIOR,20,5,480,290); 

break; 

case ’A’: case ’a’: plotniode^’a’; 
break; 

case ’T’: case V: trig=l; 
break; 

case ’C’: case V: trig=0; 
break; 
case 0: 

chiri=getch(); 

switch(cliin) 

{ 

case RIGHT: gainupdown=l; 

gainplot(); 

break; 

case LEFT: gainupdown=-l; 

gainplot(); 

break; 

case UP: positionsign = l; 
positionplot(); 


96 



break; 

case DOWN: positionsign^-l; 

positionplotQ; 

break; 

case FI: if(zoom>l) zoom=zoom-l; 

_settextposition( 1,60); 
printf(”%i 71 ,zoom); 
break; 

case F2: if(zoom<10) zoom=zoom-fl; 

_settextposition( 1,60); 
printf(*%i , zoom); 
break; 

case F4: savedatQ; /* Save step responses if needed */ 
break; 

case F5: yawanglc-yawangle-yawanglestep; 

newmixer(); 

break; 

case F6: yawangle-yawangle+yawanglestep; 

newmixer(); 

break; 

case F9: rota=0; 

_settextposition(30,64); 

printf(”OfF\zoom); 

break; 

case F10: rota=l; 

_scttext position (30, 64); 
printf("On ”,zoom); 
break; 

} 

break; 

case ’E’xase V: chd=l; 
break; 

case ’D’xase ’d’: chd=0; 
break; 

case ESC: ch=ESC; break; 
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} 

} 

chin=V; 

} 

/**************************************************************************/ 
/* initialize: setting the parameters of the dual phase advance compensator */ 

void initialize(void) 

{ 

double dt,T,n,Tnd; 
int breakfreq; 

printf(”\n Enter Compensator’s Break frequency (170hz): "); 
scan f(” %d” breakfreq) ; /* Get the break frequency */ 

dt=l/((double) samplrate); /* period of the sampling */ 
T=l/(2.0*pi*(double)(breakfreq)); /* 1/ break frequency*/ 
printf(”T= %9.6f\n",T); 

n=10.0; /* ratio of lead to lag break frequency */ 


al l = l/((dt*dt)+4*T*dt+4*(T*T)); 
b=(dt*dt)+4*n*dt*T+4*n*n*T*T; 
c=2*dt*dt-8*n*n*T*T; 
d=(dt*dt)-4*n*dt*T+4*n*n*T*T; 
e=2*dt*dt-8*T*T; 
f=(dt*dt)-4*dt*T+4*T*T; 
printf(’’\n”); 
printf(”\n”); 
printf( T '\n T ’); 
printf(’’a=%9.Cf\n’’ ,al 1); 
printf(” b=%9. 6f\n” ,b); 
printf(’’c=%9.6f\n” ,c); 
printf(’’d=%9.Cf\n”,d); 
printf(”e=%9.6f\n",e); 
printf(”f=%9.6f\n T \f); 
getch(); 

} 


/a**************************************** 
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/* Plotdat: plot of signals */ 
void plotdat(void) 

{ 

kv=4+(j+l)*48-(int)(v*2*zoom); 
if(kv>=290) kv=290; 
_setcolor(plotcolor); 
_setpixel(ix,olddat[ix][j+l]); 
_setcolor(datcolor); 
_setpixel(ix,kv); 
olddat[ix][j+l]=kv; 


} 

/*******************♦******************** 
/* trigplot: plot of signals */ 

void trigplot(void) 

{ int plotcenter=148; 


kv=plotcenter-(int)(v*10*zoom); 

if(kv>=290) kv=290; 

_setcolor(plotcolor); 

_setpixcl(ix,oiddat[ix][j+l]); 

_setcolor(datcolor); 

_setpixel(ix,kv); 

olddat[ix][j+l]=kv; 


} 

/***************************** ****** 

/* gainplot: to display gain on each degree of freedom graphically */ 

void gainplot(void) 

{ 

int gainknob,knobcolor; 
switch(ch2) 


{ 

case ’x’: 


if((gain[0]>=0) kk (gain[0]<=2)) 

{ 

knobcolor=G+gaiiiupdown; 
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_setcolor(knobcolor); 
gainknob=40+ (int)(gain[0]*80.0); 

_ rectangle(_GFILLINTERIOR,gainknob,320,gainknob+3 t 340); 
gain[0]=gain[0]+gainupdown*gainstep; 

_settextposition(21,27); 

printf( w %4.3f\gain[0]); 


} 

else 

if(gain[0]<0) gain[0]=0; 
if(gain[0]>2) gain[0]=2; 
break; 
case V : 

if((gain[l]>=0) kk (gain[l]<=2)) 

{ 

knobcolor=6+gainupdown; 

_setcolor(knobcolor); 

gainknob=40+(int)(gain[l]*80.0); 

_rectangle(_GFILLINTERlOR,gainknob,352,gainknob+3,372); 
gain [l]=gain[l] 4-gain updown*gainstcp; 

_settextposition(23,27); 

printf(”%4.3F,gain[l]); 

} 

else 

if(gain[l]<0) gain[l]=0; 
if(gain[l]>2) gain[l]=2; 
break; 
case V: 

if((gain[2]>=0) Lt (gain[2]<=2)) 

{ 

knobcoior=6-hgainupdown; 

_sctcolor(knobcolor); 

gainknob=40-f(int)(gain[2]*80.0); 

_rectangle(^GFILLINTERIOR,gainknob,384,gainknob+3,404); 

gain[2]=gain[2]+gainupdown*gainstep; 

_seUextposition(25,27); 
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printf(”%4.3P,gain[2]); 

} 

e 

if(gain[2]<0) gain[2]=0; 
if(gain[2]>2) gain[2]=2; 
break; 
case ’m’: 

if((gain[3]>=0) LL (gain[3]<=2)) 

{ 

knobcolor=6-fgainupdown; 

_setcolor(knobcolor); 

gainknob=40+(int)(gain[3]*80.0); 

_rcctangle(_GFILLINTERIOR,gainknob t 416,gainknob+3,436); 

gain[3]=gain[3]+gainupdown*gainstcp; 

_settextposition(27,27); 

printf(”%4.3r,gam[3]); 

} 

else 

if(gain[3]<0) gain[3]=0; 
if(gain[3]>2) gain[3]=2; 
break; 
case ’n’: 

if((gain[4]>=0) (gain[4]<=2)) 

{ 

knobcolor=G+gaimjpdown; 

_sctcolor(knobcolor); 
gainknob=40-f (int)(gain[4]*80.0); 

_rectangle(_GFILLINTERIOR,gainknob,448,gainknob-f3,468); 

gain[4]=gain[4]+gainupdown*gainstep; 

_scttextposition(29,27); 

printf(”%4.3F,gain[4]); 

) 

else 

if(gain[4]<0) gain[4]=0; 
if(gain[4]>2) gain[4]=2; 
break; 
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} 


} 


/* positionplot: control and display of position knobs 
void positionplot(void) 

{ 

int knobcolor,positionknob,bkcolor; 

knobcolor=10; 

bkcolor=4; 

if(trig= = l) 


ix=25; 


***************/ 

*/ 


samplcr=0; /* counter for collecting data in ISR */ 
switch(ch2) 

{ 

case V: 


__setcolor(bkcolor); 

_rectangle(_GFILLINTERI0R,31 0,320, 401,340); 

__sctcolor(knobcolor); 

posi tion[0]= posi tion[0]-|- posi tionsign 4= posi tionstep; 
if(position[0]<-l) position[0]=-l; 
if(position[0]>l) position[0] = l; 
positionknob=385+(int)(position[0] 4=75.0); 

_rectangle(_G FILLINTERIO II, posi tionknob, 320, posi tionknob+ 1,340); 

break; 
case ’y’: 

_sctcolor(bkcolor); 

_rectangle(_GFILLINTERIOR,310,352,4Gl,372); 

_setcolor(knobcolor); 

position[l] = position[l]-f positionsigntpositionstep; 
i f( posi tion [ 1 ] < * 1 ) posi t ion [ 1] =- 1 ; 
if(position[l]>l) position[l]=l; 
positionknob=385+(int)(position[l] 4=75.0); 

— rec tangle( _G FI LLINTERI OR, posi Lion knob, 352, posi tionknob-f 1,372); 

break; 

case V: 

_setcolor(bkcolor); 
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_rectang!e(_GFILLINTERIOR,310,384,461,404); 

_setcolor(knobcolor); 

position [2] =position[2]-Hpositionsign*positionstep; 
if( position [2] <- 1 ) posi tion [2] =- 1 ; 
if(position[2]>l) position [2] = 1; 
positionknob=385+(int)(position[2]*75.0); 

_rectangle(_GFILLINTERIOR,positionknob,384,positionknob+l,404); 

break; 
case ’m’: 

_setcolor(bkcolor); 

_rectangle(_GFILLINTERIOR, 310, 4 16,461,430); 

_setcolor(knobcolor); 

posi tion [3] =position[3] + posi tionsign*positionstep; 

if( position [3] <- 1 ) position [3] =-l; 

i f ( posi tion [3] > 1 ) position[3]=l; 

positionknob=385+(int)(position[3]*75.0); 

_rectangie(_GFILLINTER10R,positionknob,416,positionknob-|-l,436); 

break; 
case ’n’: 

_setcolor(bkco!or); 

_rectangle(_GFILLINTERIOR, 3 10,448,461,468); 

_setcolor(knobco!or); 

posi tion [4] =posi tion [4] -f posit iousign* posi tionstep; 

/*_settextposition( 15,62); 
printf(” % Exposition [4]); ♦/ 

imposition [4] <- 1 ) position[4] =- 1 ; 
if(position[4] > 1 ) position[4] = 1 ; 
posi tionknob=385+(int)(posi tion [4] *75.0); 

_rectangle( _G FILLI NTER1 OR, posi tionknob, 448, positionknob-f 1,468); 

break; 

} 

} 

/ **************************************** j^**********^^^^^,^^^ j 

/* shutdown: outputs zero to current drivers*/ 
void shutdown(void) 

{ 
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int dtoa; 

for(dtoa=0;dtoa<=4;++dtoa) 

{ 

outp(DDAbase+dtoa*2,0);/* 00000000 for low byte at zero*/ 
outp(DDAbase+dtoa*2+l,8);/* 1000 for high byte at zero */ 

} 

} 

/********** *******************************t************ ++++++++ ^ ++++ ^^ 

/* timersetup: sets up the sample rate clock on the second ADC for interrupt */ 
void timersetup(void) 

{ 

int rate; 

/* Timer ic AM9513 settings*/ 

outp(ADC_2+4,19G); /* set no auto increment, interrupt on adc, 
external trriger */ 

outp(ADC_2+9,23);/* Data pointer to master mode reg. Control Group*/ 
outp(ADC_2+8,0); /* Set master mode register for scalar*/ 
outp(ADC_2-f 8,144); /* BCD division, enable increment, 8 bit bus*/ 

/* FOUT off, compar disabled ; TOD disabled*/ 

outp(ADC__2-f9,5); /* 5 Set data pointer to counter 5 */ 

outp(ADC_2+8,33);/* 49 No gating, Count on rising edge,*/ 
outp(ADC_2+8,13); /* 13 F3 source (10000 hz), 

/* disable special gating Reload from load, repeat count, Binary, */ 

/* count down, active high output*/ 
rate=(int)( 10000. 0/samplrate); 

outp(ADC__ 2+8, rate); /* Binary number for the counter to repeat*/ 
outp(ADC_2+8,0); 

outp(ADC_2+9,112);/* load and start */ 

} 

/* savedat() saves data to file */ 
void savedat(void) 

{ 

char fname[12]; 
int ij; 

FILE *fp; 
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_settextposition(25,64); 
printf(”Save data? y/n\n”); 
ch=getch(); 

if((ch==’Y’) || (ch==’y’)) 

{ 

_settextposition(25,64); 
prill tf(” Enter File Name”); 

_settextposition(2G,64); 

scan f ( ” %s” , L f name ) ; 

if((fp=fopen(fname,”w-{-”))!=NULL) 

{ 

fprintf(fp,”stepdat=[\n”); 
for(i= 1 ;i<=200;iH — h) 

{ 

for(j=0j<=4;j++) 
fprintf(fp,”%Ie ”,savdat[j][i]); 
fprintf(fp,”\n”); 

} 

fprintf(fp,"];\n”); 

fprintf(fp,”gains=[\n”); 

for(i=0;i<=4;i-h-f) 

fprintf(fp,”%ie \n”,gain[i]); /* Save the gains */ 

fprintf(fp t w ];\n w ); 

fciose(fp); 

} 

else 

printf(”Oops file error”); 

} 

_scttextposition(25,64); 
printf(” ”); 

_scttextposition(2C,64); 
printf(” -); 

} 

/************************** *************************************************/ 
/* cosmak : calculates cos values for angles 0..3G0 */ 

void cosmak(void) 
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{ int i, number; 
double radang; 

maxnum=(int)(360.0/yawanglestep); 

yawangle=0; 

for(i=0;i<==maxnum;i++) 

{ 

radang=(yawangle/180.0)*pi; 
cosdat [i] =cos( radang) ; 
yawangle=yawangle-fyawanglestep; 

} 

yawangle=0; 

} 

/******** + ^ + j 

/* newmixer : calculates new mixing matrix and current distribution.*/ 

void newmixer(void) 

{ int i j,k,nextone, index I,index2,index3,index4,index5, seventy 2; 
int angindex; 

double angstep=C, yawangletemp; 
double mixtemp[5] [5],interpol; 

angindex=(int)(yawangle/yawanglcstcp); /* Index of the yaw angle */ 
seventy2=(int)(72.0/yawanglestep); /* Index of 72 deg based on*/ 
nextonc=l; /* the yaw step chosen */ 
if (angindex<0) 

{ 

angindex=maxnum+angindex; 

ncxtone=-l; 

} 

indcxl=angindex; /*determination of cosine matrix */ 
index2=abs(seventy2-angindex); /*index for calculating the zero */ 
index3=abs(2*seventy2-angindex); /*position current. Every index* */ 
index4=abs(3*seventy2-angindex); /*is 72 degrees apart from its */ 
indcx5=abs(4*seventy2-angindex); /*adjascnt neighbor. */ 
if(indexl>maxnum) /* The five if statements rap around */ 
index l=indexl-maxnum; 

if(indcx2>=maxnum) /* the indeeis to the begining after */ 
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index2=index2-maxnum; 

if(index3>=maxnum) /* 360 degrees rotation */ 
index3=index3-maxnum; 
i f ( i ndex4 > = maxn u m ) 
index4= index4-maxnum; 
if(index5>=maxnum) 
index5=index5-maxnum; 

_settextposition( 10, 10); 

offset[0]=initialoffset[0]*cosdat[indexl]; /* Levitation current calculation */ 
offset[l]=initialoffset[0]*cosdat[index2]; /* using the cosine array, which */ 
offset [2] =in itialoffset[0] *cosdat[i ndex3] ; /* selected deluding on the angle */ 
offset[3]=initialoffset[0]*cosdat[index4]; /* of the model. Initialoffset[0] */ 
offset[4]=initialoffset[0]*cosdat[index5]; /* is the highest steady current. */ 
yawangletemp=fabs(yawangle); 

if(yawangle>— 360) /* Adjustment for augles>360*/ 
yawangletemp=yawangle-360; 

ang=(int)(yawangletcmp/angstep); /* Determination of number of steps */ 
nextone=l; 

/* Determination of the interpolating coefficent */ 

interpol=((yawanglctcmp)-(doublc)((ang)*angstcp))/angstep; 

if(yawangle<0) 

{ 

nextonc=-l; 

ang=G0-ang; 

} 

/* interpolation between the mixing matrices */ 
for(i=0;i<=4;i++) 

{ 

for(j=0;j<=4;j++) 

{ 

mix[i][j]=interpol*(mixall[i][i][ang+nextonc]-inixall[i]lj][ang]) 

+mixall[i][j][ang]; 

} 

} 

_settextposition(25,64); 

printf(”%6.3r .yawangle); 
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/* Intrrupt service routine */ 

/♦ datin() obtains data from ADC in the array */ 
void ^interrupt _far datin(void) 

{ 

unsigned int yll,Outport; 
int k,df; 

for(k=0;k<=4;k++) 

{ 

mode = 7; 
flag = 0; 
params[0] = k; 
params[l] = 0; 

mscl_das40 (fcmode, params, fcflag); 
if (flag != 0) process_error(); 
y=rparams[0]; 

vsensor[k]=(float)(y/409.5); 

} 

_cnable(); 

/*********** i^********************^* ******************* ******************/ 

/* decoupler */ 
vl[2] = vscnsor[l]-5; 

vl[5] = ((vscnsor[3]-f vsensor[4]-10)*-0.5); 
v 1 [8] = ( ( vsensor [0] + vsensor [2] - 1 0 ) * 0 . 5 ) ; 
vl[l l] = (vsensor[0]-vsensor[2]); 
vl[14] = (vsensor[3]-vsensor[4]); 

if(sampler<=200) 

{ 

for(df=0;df<=4;df++) 
savdat[df][sampler]=vl[24'dh3]; 
sam pler-f-h; 

} 

/* compensator: dual phase advance using backward difference method */ 

/* vl[2+3*l]=vl[2+3*l]+position[J]*4; */ 
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for(l=0;l<=4;i++) 

{ 

v2[2+3*l]=all*(gain[l]*(b*(vl[2+3*l]+position[l]) 

+c«vl[H-3*l]+d*vl[3*l])- 

e*v2[l-b3*l]-f*v2[3*I]); 

} 

/************** t**^*******************^********************************/ 
/* current formation*/ 

for(l=0;l<=4;l++) 

{ 

current[l]=v2[2]*mix[l][0]+v2[5]*mix[l][l]+v2[8]*niix[I][2]4- 

v2[l l]*mix[l] [3]+v2[14]*mix[l][4]*foffset[l]; 

/* + ***++***+*++********* + * + ****++ + + + + *+++*++++++++++++++******+++++++**+* j 

/* Data outputs to the five D/As */ 
if(fabs(current[l])<10.0) 
yll=(unsigned int)(204.75*(current[l]+10.0)); 

Outport=DDAbase+l*2; 

_disable(); 

_asm 

{ 

push ax; 
push dx; 
mov dx t Outport; 
mov ax,yll; 
out dx,ax; 
pop dx; 
pop ax; 

} 

_enable(); 
vl[3*l]=vl[l+3*l]; 
vl[l+3*l]=vl [2+3*1]; 
v2[3*l]=v2[l+3*l]; 
v2[l+3*l]=v2[2+3*l]; 

} 

_disablc(); 
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_asm 


{ 


push ax 
push dx 

mov dx,ADC_2 ;Load the ADC board address 

add dx,6 ; point to adc high byte register 

or al,al ; clear al 

in al,dx ;output command 

mov dx,20h ; load 8259 address 

mov al,20h ; set normal priority, EOI=l, (65h) 

out dx,al ; output command 

pop dx 

pop ax 

} 

_enable(); 


} 

t* 

/********* ♦♦***♦♦♦*♦****♦*****♦♦*♦*♦****+♦♦♦♦♦♦*♦*****************♦*♦*****+/ 
void adcinitializc(void) 

{ 


/* DAS-40 Initialization */ 
mode— 0; 


flag=0; 

params[0]=0; 

mscl_das40(&;mode,params,&:flag); 
if(flag !=0) process_error(); 

_c]earscreen(_GCLEARSCREEN); 


} 



void process_crror() 


{ 


", flag k Oxff, ((flag k OxffOO) » 8)); 


putch(7); putch(7); 

printf (%*** Error %u detected in mode %u 
exit(l); 
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} 

/************************+***+****++**+***+++++++++++**+*+***+********* J 

void acknowledge(void) 

{ 

_asm 

{ 

push ax 
push dx 

mov dx,ADC_2 ;Load the ADC board address 

add dx,6 ;point to adc high byte register 

or al,al ; clear al 

in al,dx ;output command 

mov dx,20h ; load 8259 address 

mov al,20h ; set normal priority, EOI = l, (65h) 

out dx,al ; output command 

pop dx 

pop ax 

} 

} 

/************** it ****************************************************** / 
void bcactive(void) 

{ 

/* stay in memory*/ 

printf^Keep Controller Active? y/n\n w ); 
ch=getch(); 

if((ch==’Y’) || (di==V)) 

{ 

_asm 

{ 

push ax; 
push dx ; 
mov ah, 31h ; 
mov al,0; 
mov dx,50h; 
int 21 h; 
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pop dx; 
pop ax; 

} 

} 

else 

{ 


_dos_setvect(intnum,oldnum); 

shutdownQ; 

} 


/* getdatQ loads mixing matrix data*/ 


void getdat(void) 

{ 

char fname[12]; 
int ij,k,dim; 

FILE *fp; 

printf(” Enter Data File Name'’); 
_settextposition( 15,30); 
scanf(” %s” ,&.fname); 

if((fp=fopen(fname,’'r+”))!=NULL) 

{ 

printf(” Please wait for data to load\n”); 

fscanf(fp,”%d”,&dim); 

printf(” Number of matrices arc: %d \n ”,dim); 
for(k=0;k<=dim-l;k++) 

{ 

for(i=0;i<=4;i++) 

{ 

for(j=0J<=4j++) 

{ 

fscanf(fp,” %11” m ixall [i] [j] [k] ); 

} 

} 

} 
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printf(” Data was successfully loaded, hit Enter”); 
getch(); 
fclose(fp); 

} 

else 

fprintf(stderr,”Oops file error”); 


